Technical Report 1056 



Dexterous 

Robotic Hands: 

Kinematics 

and Control 



Sundar Narasimhan 



MIT Artificial Intelligence Laboratory 



Dexterous Robotic Hands: Kinematics 

and Control 



by 



Sundar Narasimhan 

B. Tech. Mechanical Engineering 

Indian Institute of Technology, Madras, India 

(1983) 



©Massachusetts Institute of Technology 1988 



Revised version of a thesis submitted to the Department of Electrical Engineering and Computer 
Science on October 15, 1987 in partial fulfillment, of the requirements for the Degree of Master of 
Science in Electrical Engineering and Computer Science 

This report describes research done at the Artificial Intelligence Laboratory of the Mas- 
sachusetts Institute of Technology. Support for the Laboratory's Artificial Intelligence 
Research is provided in part by the Office of Naval Research University Research Initiative 
Program under Office of Naval Research contracts N00014-86-K-0685 and in part by the 
Advanced Research Project Agency of the Department of Defense under Office of Naval 
Research contract N00014-85-K-0124. 



Dexterous Robotic Hands: Kinematics and Control 

by 

Sundar Narasimhan 

Abstract. This report presents issues relating to the kinematics and control of dexter- 
ous robotic hands using the Utah-MIT hand as an illustrative example. The emphasis 
throughout is on the actual implementation and testing of the theoretical concepts pre- 
sented. The kinematics of such hands is interesting and complicated owing to the large 
number of degrees of freedom involved. 

The implementation of position and force control algorithms on such tendon driven 
hands has previously suffered from inefficient formulations and a lack of sophisticated com- 
puter hardware. Both these problems are addressed in this report. A multiprocessor 
architecture has been built with high performance microcomputers on which real-time al- 
gorithms can be efficiently implemented. A large software library has also been built to 
facilitate flexible software development on this architecture. The position and force control 
algorithms described herein have been implemented and tested on this hardware. 
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Chapter 1 
Introduction 



Within the artificial intelligence community, robotics is often characterized as having to do 
with "relating perception to action". Perception deals with the acquisition of information 
through a wide variety of mechanisms, and the process of using such information to affect 
the state of the world intelligently is the task of present day robotics. 

While there have been great strides in our understanding of some of the problems associ- 
ated with "relating perception to action", there are others which still defy the concentrated 
attack of a number of research efforts. 

One of the important capabilities required of robots is the ability to grasp and manipu- 
late objects. In order that we discover the fundamental principles that guide manipulation, 
it is extremely important that theoretical analyses proceed hand in hand with practical 
implementations. The increasing availability of dexterous hands and other mechanically 
sophisticated devices, provides ample scope for constructing testbeds for experimentation. 

It must also be mentioned that while the technology for building better robots has 
advanced tremendously, our understanding of how to best use these robots has scarcely 
widened. Partly this has been due to the lack of sophisticated computer architectures to 
control robots. Often, (even in research laboratories) one finds a costly robot hooked up 
to an old computer on its last legs, programmed by a few wizards in an arcane assembler 
language. Such situations result in ever-widening gaps between theory and practice, with 
most theories of manipulation being relegated to doctoral theses reports. 

In this technical report, I hope to present a view of robotics as it applies to dexterous 
robotic hands. These robotic hands tend to be extremely complex devices with a large 
number of joints compared with the traditional six degree of freedom robot. Consequently, 
as we will see in subsequent chapters, problems that have been considered solved for all 
theoretical purposes, reappear owing to purely practical considerations. Besides the prob- 
lems that beset conventional robots, dexterous hands give rise to quite a few problems of 
their own. 

This report addresses a number of issues that arise when one tries to implement control 
algorithms on such robot hands, using the Utah-MIT hand as an illustrative example. The 
problems that had to be solved involved kinematics, control and computational architecture 
issues, and consequently involved different areas of theoretical and experimental inquiry. 
It is my hope that after reading this document the reader will get a sense of the issues 
involved and get some insight into a few of the problems that I have tried to address. 
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1.1 Dexterous Robot Hands 



One of the glaring deficiencies in today's robots is in their flexibility. The earliest argu- 
ments for the use of robots indeed stressed their versatility when compared to conventional 
machine tools. And yet, today one finds 85 percent of most robots used in industry being 
relegated to tasks like spot welding or spray painting - tasks that do not require a great 
deal of dexterity or co-ordination. 

The problem of building mechanically better robots capable of higher performance is 
being addressed (see Salisbury [1982], Jacobsen et al. [1983]). In the following chapters, 
I deal exclusively with such advanced robots which are mechanically more complex than 
conventional robots. Their actuation and transmission systems are rather sophisticated. 
These dexterous hands as they are called, are devices with a number of joints (see Fig. 1.1 
for a picture of the Stanford-JPL hand which is an example of such a device). 




Figure 1.1: The Stanford-JPL Hand. 

Since robots were invented, there has been a wide variation in their designs, but most 
of them are equipped with what has become famous as the two-jaw gripper. This gripper 
is the robot's end-effector, its primary way of interacting with objects in its environment 
(see Figure 1.2). But as is rather obvious, the range of motions that a robot can impart to 
a grasped object and the range of forces it can exert on it with such a gripper, is rather 
limited. Dexterous hands with a number of joints afford a more flexible alternative to this 
primitive form of grasping and manipulating objects. 

There are a number of reasons why studying such hands could be immensely useful. 

• Flexibility argument: 

Conventional robot grippers are often just a pair of vice-like jaws. Articulated me- 
chanical hands with a number of fingers are much more versatile. Such hands, with 
their large number of joints, can adapt to objects of different shapes. They can grasp 
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Figure 1.2: Picture of a conventional 2-jaw gripper. 



objects more stably because of a larger number of points of contact or gripping sur- 
faces. They can perform fine motions without moving the entire arm around, and can 
reorient the grasped object without regrasping. 

Augmented with sensory capabilities, these hands will become useful tools for haptic 
exploration. Touch sensors can help in the identification and recognition of objects 
grasped by such hands. They can also help in determining properties of objects 
like surface texture and temperature, and provide information as to what kind of 
contact is being made between the hand and a grasped object. Such information 
is extremely important to understand the physics of manipulation tasks, but is not 
usually accessible to non-contact sensing modalities like vision. 

• The Artificial Intelligence argument: 

Our current understanding of machine dexterity is fairly low. One of the important 
capabilities required of intelligent, autonomous machines, is that they be able to 
manipulate the objects in their immediate environment. This is necessary to acquire 
active information about objects that passive sensory mechanisms like vision cannot 
provide, to interact with these objects in a meaningful fashion as required by the task, 
and to use and manipulate tools that vary in size and shape. With hands that have 
multiple fingers and multiple degrees of freedom, such a capability becomes possible. 
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Recently, there have been efforts to move away from the "blocks-world" paradigm 
in A.I. and build real systems that must deal with the nature of the real world (see 
for example Brooks [1986]). This report presents our approach to issues involved in 
building and programming a robot to manipulate objects. 

• Empirical argument: 

Robot hands are complex mechanical devices, far more complex than present day 
robots. From a kinematic viewpoint, this makes them interesting objects worth study- 
ing for their own sake. The study of such complex kinematic chains can lead to a 
better understanding of some of the basic principles involved in machine design and 
pave the way to the synthesis of better robots and hands. 

Besides this, studying such hands can also provide insight into the study of how 
human hands function. Such an understanding could have substantial impact on 
human hand prostheses, and our understanding of biological motor control. 

Although some of the earliest mechanical hands were aimed at prosthetic applications, 
the focus of present-day robot hands has shifted toward researchers in robotics laboratories. 
These later attempts are aimed at providing a basic understanding of what it means to 
achieve dexterous manipulation. A number of such hands have been built, and hand control 
research has become an active field of inquiry in the past few years. 

1.2 A Framework for Hand Control 

In this section an overall framework for robot hand control and planning is presented. 
Different problems that arise in the control and programming of robot hands are introduced, 
and I hope that such a discussion will provide the motivation for the work presented in 
this report. Such a discussion should also be helpful in evaluating and understanding the 
contributions made by previous and future research efforts. A brief summary of previous 
work pertaining to hand control research is presented in the next chapter. 

Hand control involves a number of different issues. To begin with, it is illustrative to 
consider the block diagram shown in Figure 1.3. As can be seen from this relatively high 
level specification, there are basically two kinds of hand control which follow from their 
counterparts in conventional robotics. We will first briefly describe what these types of 
control involve, and then enumerate the problems to be solved before they can be imple- 
mented to run efficiently. 

Pure position control of a conventional robot involves controlling the robot's position at 
all times to achieve a specified task. For controlling a revolute manipulator, for example, 
these positions could be a stream of joint angles over time, or the cartesian positions and 
orientations of the tip of the manipulator. There are many metrics by which a position 
controller's performance can be quantitatively measured like accuracy, repeatability, stability 
and robustness. Grasping and manipulating an object can be specified purely in terms of 
the motions that the fingers go through, if each of the fingers is treated as an independent 
robot. It is easier however to think of the motions that a grasped object is making, and 
specify these motions in terms of this object. Such a specification would be modular and 
would be independent of the particular kind of robot hand used. 
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Figure 1.3: Block diagram of the controller. 



Force control, on the other hand, involves specifying and controlling the forces of inter- 
action between a robot and its environment. Since a robot hand is almost always in contact 
with an object in its environment while it is performing useful work, this mode of control is 
uniquely important for robot hands. Such a force controller specification usually takes the 
form of a stiffness matrix that the grasped object together with the hand control system 
present to the environment. 

There are many problems that arise in actually implementing these types of control 
algorithms. 



1.2.1 Forward Kinematics 

This refers to the problem of computing the cartesian co-ordinates of the finger tips 
of an articulated hand from its various joint angles. Fortunately, most of the articulated 
hands' fingers are individually less complex than conventional six degree of freedom robots. 
Hence the forward kinematic problem is usually simpler for articulated hands at the finger 



6 Chapter 1 Introduction 

level. Such a treatment can be useful, for example, in the initial phases of a manipulation 
operation, while the hand's fingers are moving in free space, and are not in contact with 
the environment. 

At the object level, once the fingers of a robot hand come into contact with a grasped 
object, the fingers can no longer be approximated as serial link kinematic chains. What 
we really have is a closed loop kinematic chain, whose degrees of freedom at the contacting 
surfaces depend on the type of contact made. The forward kinematic problem for such a 
closed loop chain mechanism involves computing the position and orientation of the grasped 
object (which is the output variable that one is interested in), given the various joint angles 
of the robot hand. This is a harder problem for robot hands than it is for conventional 
robots. 

Another factor that compounds the problem in the case of robot hands is that multi-link 
contact occurs often. While conventional robots typically rely on making contact with a 
grasped object with only the tips of their end effector, this is not the case with dexterous 
hands. We only need to look at any typical human manipulation task to realize that we 
almost always make contact with a grasped object at more surfaces of our fingers than just 
the finger tips. With multi-link contact, one is no longer interested in just the positions 
and orientations of the end-point or end-effector, but in the positions and orientations of 
intermediate links as well. Not only does such a contact help secure a grasped object more 
stably, but it also restricts the mobility of the hand's joints in a complex fashion. 

To summarize, the problems are: 

1. Computing the configuration of the finger tips given the joint angles of each finger. 

2. Computing the configuration of a grasped object given the joint angles, assuming a 
finger-tip grasp. 

3. Computing the configuration of a grasped object given the joint angles and locations 
of contact on the various finger joints. 

1.2.2 Inverse Kinematics 

The problem of computing the joint angles given the cartesian co-ordinates of the finger 
tips or end-effector is more complicated, even for conventional robots. In the case of articu- 
lated hands, the problem is exacerbated by the enormous amount of redundancy involved. 
From our statement of the forward kinematic problem for robot hands, it can be seen that 
the inverse kinematic problem is one of finding out the joint angles corresponding to a 
configuration of the grasped object. 

If purely finger tip 1 grasps are assumed, this problem can be broken into two subprob- 
lems that involve 

1. computing the positions of the finger tips given the position and orientation of the 
grasped object, and geometric information pertaining to the grasp, and then 

A finger tip grasp is one wherein an object is grasped purely by the tips of the serial kinematic chains 
that form the hand's various fingers. Such a grasp leads to every closed loop in the system containing all 
the links of two fingers and the grasped object. 
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2. computing the joint angles of each finger given its finger tip position and orientation. 

Only the second portion of such a computation would then depend on the kinematics of 
the particular hand involved. A similar formulation can also be obtained for the forward 
kinematic problem given this rather restrictive assumption. 

For a purely positioning and orienting task, the number of degrees of freedom required 
is only six, and yet the human hand-arm system comprises twenty- nine degrees of freedom. 
This would seem to be far more than what most tasks typically require. The success of the 
human hand-arm system in manipulation tasks, however, serves as an existence proof for 
the desirability of such redundancy. Even with very simple robot hands, multiple inverse 
kinematic solutions can be expected to exist. This points to the need for quantitative 
criteria that can help optimization algorithms choose the best configurations of the hand's 
joints for particular tasks. As is the case with most optimizing problems, the problems 
involved are 

1. defining computable indices of performance, and 

2. developing algorithms that can use these indices to compute optimal solutions. 

1.2.3 Sensing 

It is possible that the success of the human hand in manipulation tasks is purely related 
to the sophistication and rich variety of the sensor information that the motor system can 
make use of when needed. Current robots and robot hands are not very sophisticated 
devices when it comes to sensing their environment. Most robots come equipped with 
position and maybe velocity sensors but very little else. In manipulation tasks however, it 
is important to know where contact is being made with a grasped object along the finger 
tips and how the nature of this contact is changing. 

Designing sensors for dexterous hands is complicated for two reasons: 

1. Since there are a large number of joints and actuators, each sensor has to be repli- 
cated a number of times. The enormous number of sensors necessitates sophisticated 
multiplexing and layout schemes to minimize wiring and maximize reliability. 

2. The space constraints in a dexterous hand are rather severe. Often sensors must be 
designed to fit into the only space available for them, which may make it impossible 
to use certain transduction technologies. 

There are many ways in which sensors interact with the controller that may be struc- 
tured as shown in Figure 1.3. 

Conventional position, velocity and force sensors can be used to implement stable and 
repeatable position and force control feedback loops. Touch sensors, on the other hand, can 
be used to sense when contact is made and precisely what kind of contact is being made. 
The object localization problem, refers to the problem of computing the configuration of a 
grasped object based on information obtained from such sensors. 

Touch sensors can be used at the higher levels to implement guarded moves. For exam- 
ple, most intermediate level robot programming languages have a construct similar to the 
one shown below: 
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move y until force y > 50 



Such conditional action statements can form the basis for iteration, execution or logic 
branching and even recursion. 

Besides such statements that trigger when force or position values exceed certain thresh- 
olds, other uses for sensor information are also possible. One possibility that has been 
suggested in the force control literature is the switching of control laws once contact has 
been made with a surface in the environment. 

Sensor information could also be used to trigger further planning steps. Such a flow of 
information from the lowest to the highest levels in the control hierarchy has begun to be 
explored only recently. Information about errors occurring during the execution of a task 
can be used to learn over successive trials. Tactile sensors have been constructed and even 
mounted on finger tips of a dexterous hand, but information provided by such sensors has 
until now not been used for control or planning. 

1.2.4 Programming 

Robot programming is still a tedious and unrewarding task. Starting with teach pen- 
dants of yester years, we have progressed today to what one may call intermediate level 
programming languages. A number of research papers have addressed the issue of auto- 
matic and task level programming but none have yet resulted in practical systems. This 
may partly be due to the difficulty of the problem but also due to considerable ambiguity 
in what researchers typically consider a task to be. Even now, no useful taxonomy of tasks 
exists that a theoretician or a practitioner can agree upon as a set of useful tasks that a 
robot must be capable of doing. The search for a truly general purpose task level program- 
ming language can be considered similar to the problem of searching for a truly general 
purpose instruction set to program computers with. 

Current robot programming languages require the user or programmer to be aware of 
too much detail with respect to the kinematics and control. If a programming language is to 
be successful at all, it has to endeavor to hide this complexity below workable abstractions. 
It is easy to write statements in a fictitious automatic programming language like 

moveto coke.can 
grasp coke_can 
pickup coke_can 

without realizing the number of problems that need to be solved before even a subset of 
these primitives can be implemented. 

One should also be wary of the temptation to shy away from these high level program- 
ming languages. At the lowest level, robots are composed of joints and hence, in principle, 
can always be programmed in joint level programming languages. But such methods are 
akin to using machine and assembler level languages to attack computational problems. 

One argument against automatic programming has been purely economic. The propo- 
nents of this argument claim that if the time taken to develop and debug a robot program 
is x and the time it spends running (i.e. actually executing) is y, it makes sense to reduce 
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x only if it is considerable when compared to the production time. This does happen to be 
true for complex robots today. Higher level programming languages not only reduce design 
and debug time, but they are infinitely more readable and easy to maintain. Moreover, 
they can be capable of doing tasks that low level robot programs can never do. 

It is my view that the conventional practice of extending regular programming languages 
to perform robot manipulation is perhaps the best we can hope for in the near future. Given 
this basic assumption, to program complex robots like the Utah-MIT hand there should 
be a hierarchy of tools available to the programmer. One should be able to drop down to 
the individual joint level if need be, and be able to use the high level abstractions in cases 
where such facilities are needed. The approach I have taken reflects this view. Most of the 
facilities for controlling and programming the Utah-MIT hand have been built as program 
libraries using an existing programming language. 

1.2.5 Modeling and Planning 

There are many levels at which a task to be performed by a dexterous hand has to be 
planned. The lowest level is perhaps the trajectory planning problem, wherein an algorithm 
computes a stream of cartesian positions or joint torques that the underlying controller 
ought to achieve to be able to perform a given task correctly. 

This problem involves computing the trajectories of the grasping surfaces (which may 
or may not be just the finger tips), given the trajectory of the grasped object. In cases 
where the hand is actually grasping an object, this problem is quite complicated, since the 
constraints imposed at the grasp surfaces by the object on the links of the hand need to be 
satisfied at every instant throughout the trajectory. 

While position trajectories are easy to compute under certain assumptions about types 
of contact, force trajectories are not. As can be seen from the block diagram of the con- 
troller, computing a stream of torques and forces to be exerted on a grasped object in order 
to make it move, may be highly inappropriate and even impossible for some tasks. For 
other tasks, like turning a screw driver however, such a specification may be easy to come 
by and may even be the most natural one. 

Besides trajectory planning, there are other levels in which planning dexterous hand 
manipulation tasks can be done. One important problem is the grasp planning problem, 
which is really composed of quite a few hard sub problems. There has been a lot of research 
in this area in the recent past. 

For the purposes of the following discussion, a grasp can be considered to be just a 
matching between grasp surfaces (which could be a point, edge, or surface on the fingers 
of a robot hand), and component surfaces on a grasped object. Like most computational 
geometric problems, a grasp involves topological information as well as geometric informa- 
tion. The former specifies what the contacting surfaces are, and the latter specifies where 
exactly they make contact and how. 

A number of obstacles remain before such grasp planning algorithms can be used in 
practice. 

1. Geometric modeling: Owing to the complexity involved in representing complex ob- 
jects (despite recent progress in CAD/CAM and computational geometry), many of 
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the algorithms are based on polygonal models. The stability of grasps, however, de- 
pends on the local curvature of the objects at the grasp points. This suggests that for 
grasp planners to be truly effective, surfaces have to be modeled rather accurately, or 
existing polygonal modeling systems have to augmented to deal with local curvature 
information in some fashion. 

2. Feasibility: Most of the grasp planners plan in an abstract geometric world, and ignore 
constraints that could be exploited to result in useful plans. The set of feasible grasps 
is the set of those grasps that are possible for a particular kinematic mechanism and 
a particular object. 

There are two interesting questions that can be asked of the feasibility issue. 

(a) Given a grasp between a particular hand and an object, determine if the grasp is 
feasible. This we will call the F-A-problem. This can be seen equivalent to the 
problem of finding a position and orientation of the palmar plane such that the 
inverse kinematics of the grasp points expressed relative to this position results 
in a set of feasible joint angles. In fact, even if one such solution exists, then the 
grasp must be feasible. 

(b) Given a particular hand and an object, synthesize all feasible grasps. This can 
be called the F-S-problem. 

Looked at one way, these questions involve rather complex calculations involving the 
workspaces of the different fingers of the robot hand. Looked at another way, such 
constraints provide powerful heuristics to prune the set of possible grasps. 

3. Reachability: This is a more complex problem than the F-S or F-A problems. A 
reachable grasp is one wherein there exists a collision-free path for each of the fingers 
from their current state to the state wherein the object has been stably grasped by 
the hand. All reachable grasps are feasible but not all feasible grasps may be reachable. 

The reachability problem as described above may be a very hard problem, since it 
involves as a subproblem, the motion planning problem. It also involves taking into 
consideration other objects in the environment, and perhaps the nature of the task. 
Similar to the F-S and F-A problems one can ask questions as to the reachability of 
a particular grasp and the set of all reachable grasps. 

One approach to simplifying the problem may be to relax the collision-free require- 
ment so as to not include objects in the environment. 

4. Task Level Synthesis: How does one use information about the nature of a task when 
picking a particular grasp? When you pick up an eraser to erase a whiteboard, you 
do not hold it by its erasing surface since you know that the nature of the task 
requires you to use this surface for something else. Similar examples abound when 
one considers the innumerable tools and other objects that humans use everyday. 
Such information about task level constraints needs to be mapped into the domain 
of grasps and may prove to be one more heuristic that helps solve the grasp planning 
problem. 
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Besides grasp planning, other tasks associated with robot hands that could currently 
benefit from automation include methods to deal with the complexity of controlling such 
a robot on a day-to-day basis. An automatically calibrating, self-tuning robot is still quite 
some distance away, but the existence of humans and other animals provides proof for the 
hypothesis that such systems can be built. 

1.2.6 Error Detection and Recovery 

After the planning phase has been completed, the execution of the task needs to be 
carried out. It has been this execution that I have concerned myself with in most of the 
work that follows. Robots, even conventional ones, however, are prone to failure (especially 
on days when an important demonstration is scheduled). The current complexity of hands 
makes them even more fragile than conventional six degree of freedom robots. 

There are two approaches to solving the problem. One is to simplify mechanically 
and in terms of computer control, the software and hardware associated with a dexterous 
hand. The other approach is to develop strategies that can detect errors and recover from 
them. Recently, researchers have begun to explore the theoretical issues associated with 
error detection and recovery strategies (see Donald [1987]). Failure analyses of tasks could 
indicate the potential sources of problems and areas in which modeling and planners need 
to be made more accurate. Sensors could play a big role in the detection of errors. Their 
intelligent use could help recovery. 

1.2.7 Engineering and Design Issues 

Some of the problems involved in building a robot that has more than ten degrees of 
freedom, are purely practical in nature. These have to do with dealing with the enormous 
number of wires, communication bandwidths, computing power, and other such tradeoffs. 
There are immense problems to be solved while building high performance actuators, flexible 
transmission systems, and adequate sensors. There has been some principled work done 
in the area of mechanical design in order to determine the parameters of a workable hand. 
However, the design space for dexterous hands has by no means been completely explored 
or systematically studied. 

1.3 Outline of this Report 

In the sections above, I have tried to outline the various issues and problems associated 
with dexterous hands, specifically trying to point out those areas in which solutions from 
conventional robotics research cannot be blindly applied. Later on, solutions to some of 
these problems are presented. The emphasis throughout will be on actual implementation 
and testing of ideas. 

The first section will be devoted to discussing previous work in related areas, to place the 
research to be described in its proper context. I will then look at the problem of controlling 
a robotic device like the Utah-MIT dexterous hand by looking at its kinematic structure, 
and solving the forward and inverse kinematic problems mentioned above. Algorithms 
for doing conventional position control are outlined, and I present a threaded interpretive 
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command language that can drive such a hand using the position control paradigm. A 
computationally efficient force control algorithm is described in the section following this. 
Finally, I discuss the computational architecture that we have developed on which most of 
this work has been implemented and tested. 
The main contributions of this report are: 

1. The solution to the kinematics (both forward and inverse) of the Utah-MIT hand. 
Two approaches to resolving the redundancy are suggested and compared. 

2. A hierarchical controller for the Utah-MIT hand that includes a stable position and 
force controller, a trajectory generator, and a threaded interpretive primitive com- 
mand language. 

3. Algorithms for solving the trajectory control problem, assuming finger tip grasps with 
no slip, for finite small motions. 

4. Algorithms for computing the differential screw displacement of a grasped object, 
given the displacements of the finger tips, as part of the force control algorithm. 

5. A novel force control algorithm that is computationally very efficient. The efficiency 
of the algorithm derives from its avoidance of the Grip Jacobian in its computations. 

6. A new computational architecture that forms the basis of a new generation of multi- 
processor robot controllers in terms of hardware and software. The real-time develop- 
ment environment described herein should form a useful tool to conduct experiments 
with robots, ranging from the very simple to the most complex. 



Chapter 2 
Dexterous Hands - Past and Future 



This chapter contains a brief description of research relevant to hand control and planning. 
The discussion has been organized into sections suggested by the framework presented in 
the previous chapter. 

2.1 Design Issues 

Mechanical hands have been built and studied for a long time. Early attempts to 
build such hands were motivated because of their use as prosthetic devices. Issues that 
were considered important in the design of such hands were quite different from those that 
concern robot hand designers today. Besides, the human hand-arm system is an extremely 
complicated system to imitate. Consequently, most of the prosthetic hands built to date 
have concentrated only on providing a very limited subset of mechanical capabilities. 

Even though the design goals of such hands were modest, and the issues involved in 
their design were quite different, the biological studies of these early efforts have influenced 
recent robot hand designs. 

2.1.1 Early Studies 

The studies of Schlesinger [1919] and Skinner [1975] guided the design during these 
early attempts to emulate the so called six types of human grasping patterns. The human 
hand, however, has twenty-two degrees of freedom with which to accomplish these tasks 
(Tubiana [1981]). To this date, no artificial hand has approached this level of complexity. 
Studies carried out by Keller [1947] show that of these six grasping patterns, humans 
typically tend to use the palmar grasp. The lateral grasp was found to be the second 
most frequently used grasping pattern. This illustrates an important difference between 
human and prosthetic hands and present day robot hands; while the former rely on force 
or power grasps to accomplish their tasks, the emphasis of present-day robotic hands has 
shifted toward dexterous grasps that are often accomplished with just the finger tips. Finger 
tip grasps enable dexterous manipulation of the grasped object and precise control of its 
positioning. Power grasps that rely on structural restraint are more secure in the presence 
of disturbance forces since they rely more on the kinematic structure of the grasp to keep 
the object from slipping rather than on the forces imparted to it through the finger tips. 
When present day robot hands have to manipulate tools and exert large forces on the 
environment with the objects/tools they are grasping, the need to plan and execute power 
grasps may arise. 

Most of this early work was descriptive. One could hope that a taxonomy for describing 
human and robotic grasping patterns in a fashion that would be concise and powerful would 
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arise out of such descriptions, but none has been forthcoming. Recent attempts in a similar 
vein have included Cutkosky et al. [1986] and Iberall [1987]. 

It is clear that humans typically tend to use relatively few grasping patterns very suc- 
cessfully to deal with a large number of objects. One could perhaps hope for a database of 
such grasping patterns indexed by the nature of a task's constraints and object geometry 
to arise from these taxonomic studies but this seems to be a long-term goal that is not 
practically achievable in the near future. 

2.1.2 Industrial Grippers 

Paralleling the development of mechanisms whose primary application was human pros- 
theses, industrial machines on the factory floor have also become more sophisticated. Most 
robots used in factories today, however, are severely constrained by the kinematic structure 
of their hands which are often just a pair of parallel vice-like jaws. In fact, their inability to 
conform to a wide variety of shapes and their inability to make small movements without 
moving the entire arm, are partly the reasons for robots being used today primarily in spot 
welding and spray painting tasks: tasks that do not require a great deal of dexterity or 
co-ordination (Seering [1984]). 

To address this problem, many alternative solutions have been proposed. Changeable 
grippers have been proposed by Luo [1984]. Although these quick-change grippers enable 
high performance in those tasks for which the grippers are specially designed, they fail 
miserably to adapt to other tasks. Hollerbach [1982] suggests that the cost involved in 
designing such specialized grippers for a large number of different operations could be very 
expensive. When the robot changes from one task to another such grippers would have to 
be switched. This involves additional lost time due to gripper changing operations. 

Other exotic solutions like vacuum-suction grippers, electro-magnetic grippers and chucks, 
flexible element grippers etc., have been applied to bin picking or parts handling. Although 
some of these designs are mechanically ingenious, these devices are often highly task specific 
too. A reasonable account of such mechanisms used in industry is provided by Chen [1982]. 
Chelpanov et al. [1983] provide a more detailed account of some of the problems with the 
mechanics of industrial robot grippers. Kato [1982] provides an illustrated collection of 
numerous hand designs used both in industry and for prostheses. 

2.1.3 Dexterous Robot Hands 

Some of the limitations of present day robots could be overcome if they had arms with 
more degrees of freedom (Yoshikawa [1983], Hollerbach [1984]). The other solution with 
which we will be concerning ourselves for the rest of this document is one which involves 
multi-fingered robot hands. These robot hands are very different from conventional robot 
grippers. Some of them are very anthropomorphic. Almost all of them have many fingers, 
each of which is composed of a number of joints. A number of such hands have been 
constructed with recent advances in actuation, sensing and control technologies. (Crossley 
et al. [1977], Okada [1979], Salisbury [1982], Abramowitz [1982], Jacobsen et al. [1984]). 
Articulated hands such as these are capable of adapting to a wide variety of object shapes 
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and are capable of making extremely fine motions under computer control. Thus they 
reduce the need for special tooling while being adaptable to a wide variety of operating 
tasks. 

Salisbury [1982] presents an analysis using the condition number of the Jacobian matrix 
of a mechanism to choose parameters involved in the linkage design of such robot hands. 
Mobility analysis of different mechanisms may also be used to choose optimal configurations 
of the various fingers. The hand presented in this work is driven by tendons attached to 
electric motors. Mechanically, the device comprises three fingers each with three joints. 
Salisbury et al. [1985] continue this early work and discuss the problem of choosing link 
lengths for a redundant mechanism. 

In an another important effort, Jacobsen et al. [1984] present the design issues per- 
taining to the Utah-MIT hand which will be described in detail later. There have been a 
series of papers devoted to discussing the various engineering aspects of this project (see 
Jacobsen et al. [1985], Jacobsen et al. [1986]). This hand is pneumatically driven and is 
tendon operated. In contrast to the Salisbury hand, the design is anthropomorphic with 
four fingers. Each finger has four degrees of freedom. 

Besides these two hands, perhaps the only other hand that has actually been used to 
perform non-trivial manipulation tasks is the hand built by Okada [1979] (see also Okada 
[1982]). 

If any conclusion can be drawn at all from these various efforts, it is that the engineering 
problems involved in hand design can be separated into four very broad categories which 
involve actuation, transmission, mechanism design and sensor design. For actuation electric 
motors, hydraulic and pneumatic actuators have been used. For the transmission system, 
tendons made out of a variety of materials have proven to be the most successful. The 
mechanism and sensor design spaces however are much too large and the choices made by 
these efforts thus far have to be characterized as careful engineering tradeoffs. 

2.2 Workspace and Kinematics 

The kinematics of multi-fingered hands is quite different from that of conventional 
robots. Workspace issues involving such hands can be quite complicated. Each finger of a 
robot hand is usually simpler than a conventional six degree of freedom robot. Consequently, 
texts like those of Paul [1982], Craig [1986] or Asada and Slotine [1986], can be expected 
to provide the machinery needed to tackle the kinematic structure of the individual fingers. 
The problem of having to deal with multiple fingers, however, is hard, considering the 
closed-loop nature of the mechanism they give rise to, once the hand has grasped an object. 

In solving the kinematics problems for individual fingers, complications could arise 
owing to the redundancy present relative to a task. For example, a single finger of the 
Utah-MIT hand has four degrees of freedom. Positioning the tip of such a finger in three 
dimensional cartesian space, however, involves only three degrees of freedom. For this task, 
therefore, such a finger is redundant. Resolving the redundancies in such lower degree of 
freedom kinematic chains presents many interesting problems. 

If no such redundancy were present, then solving the kinematics of the individual fingers 
is a rather trivial problem. Once the fingers of a hand have grasped an object, the resulting 
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closed loop chain's kinematics become complicated. The motion of the grasped object and 
its configuration at any given moment are dependent on the nature and position of the 
grasping surfaces and the relative degrees of freedom at these surfaces. Contacts could be 
made at a point, along a line or along a planar surface. Each of these different types of 
contact gives rise to a different relative mobility between the hand and the grasped object. 
Workspace issues have traditionally been difficult to resolve owing to the complexity of 
the issues involved. Bajpai and Roth [1986] discuss the issues associated with closed -loop 
manipulators. Kerr's [1985] thesis contains a section devoted to workspace issues associated 
with dexterous robot hands. 

2.3 Work in Sensing 

In recent years, there has been an explosion of work in sensing and designs of sensors 
for various tasks. Some of these have been motivated by careful analyses and followed 
up by careful testing and evaluation. Most, however, have concentrated merely on the 
exhibition of a new transduction process and have stopped after a proof of concept had 
been demonstrated. 

Siegel [1986] has presented objective criteria for the design and testing of tactile sensors. 
This work also presented a promising tactile sensor based on a capacitance technology. 
Other designs have been based on optical (Begej [1984], Crosnier [1986]), capacitance (Boie 
[1984]), rheological (Brockett [1985]), magnetoelastic (Checinski [1986]), ultrasonic (Grahn 
[1986]), pneumatic (Hanafusa [1976]), and piezoelectric (Nakamura [1986]) transduction 
principles. 

A series of papers by Harmon provide valuably informative surveys on the state of the 
art with respect to issues pertaining to sensing (see for example Harmon [1980], Harmon 
[1984] and Harmon [1985]). 

Besides the construction of these sensors, there have been numerous papers on how 
these sensors can be used in algorithms for object identification (Ellis [1987], Grimson et al. 
[1984], Okada [1977]), perception of the environment to build models (Brock et al. [1985], 
Dario et al. [1985]), estimating the configuration of objects (Driels [1986], Palm [1985]), and 
to actually help in the manipulation of objects (Fearing [1986]). Of these efforts, Fearing 
[1986] (see also Fearing [1987]) and Brock et al. [1985] have actually mounted their sensors 
on robot hands. The former also provides a detailed study of the solid mechanics problems 
involved in contact phenomena. Similar such studies are being pursued by Cutkosky et al. 
([1986] and [1987]). A preliminary discussion of theoretical issues associated with tactile 
sensing can be found in Montana [1986]. 

2.4 Work in Control 

In his early work on the hand that he built, Salisbury [1982] also presented control 
algorithms for achieving stable force control. His method was based on the so-called Grip 
Jacobian matrix, and is, as we will see in the chapter on force control, computationally very 
expensive. The form of control introduced in this seminal thesis is now known as stiffness 
control. Other forms offeree control have also been documented in the literature, but none 
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has been applied to robot hands. Approaches similar to this one have been proposed by 
Kobayishi et al. [1986], and by Yoshikawa [1987]. 

Chin [1983] presents the implementation of a controller and a brief description of a 
programming language for the Salisbury hand. He introduced the concept of a grasp-frame 
that is computed as a function of the positions of the finger tips. This frame can then be 
used to compute trajectories of the finger tips once the trajectory of the grasped object 
is specified. Biggers et al. [1986] provide a summary of the issues involved in low level 
control of the Utah-MIT hand. Model based control of the Salisbury hand is addressed by 
Loucks et al. [1987] and multivariate control issues are tackled by Venkataraman et al. 
[1987]. Other issues associated with identification and estimation are addressed in a thesis 
by Speeter [1987]. 

2.5 Planning and Programming 

To summarize our survey of previous related work, we look at issues associated with 
planning that has been the target of numerous research efforts. 

Some of the problems associated with robot grasp planning were outlined in an early 
thesis by Lozano-Perez [1976]. In this paper that dealt with automated robot programming, 
the choice of a single grip from amongst the number of grips possible was recognized as a 
hard problem. The configuration space 1 approach was applied to solve a simple version of 
the problem for a parallel jaw gripper. 

Hanafusa et al. [1977] present the solution to a planar version of the grasp selection 
problem using a potential field approach to choose stable grasps. Further attempts to solve 
the planar version of the problem with simple and articulated fingers can be found in Abel 
et al. [1985], and Nguyen [1986]. 

There have been a number of attempts at analyzing the stability of a given grasp, but 
relatively few attempts toward synthesizing grasps. The work of Kerr [1984], Jameson 
[1985] and Cutkosky [1984] represent the state of the art with respect to analysis. Perhaps 
the best work related to synthesis is offered by Nguyen [1986] and Nguyen [1987]. This 
work presents algorithms that synthesize grasps that are stable and force closed based on 
purely geometric calculations. The objects to be grasped are modeled as polyhedra and 
the fingers are treated as points. 

It must be mentioned that the problems associated with feasibility and reachability of a 
grasp, mentioned in our earlier framework remain unsolved, even for hands with a relatively 
simple kinematic structure. 



1 This approach has yielded important results with respect to robot motion planning problems in the 
recent past. 
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Chapter 3 
Kinematic Issues 



The previous chapters have provided a brief overview of the various problems associated 
with dexterous robot hands and a look at previous research efforts that have tried to address 
some of these problems. 

Dexterous hands are complex manipulating devices, and some of the interesting prob- 
lems that arise in using such devices are purely kinematic in nature. This section presents 
some of these problems using the Utah-MIT hand as an illustrative example. 

3.1 Description of the Utah-MIT Hand/ Arm System 

The Utah-MIT hand consists of four fingers, powered pneumatically and driven by 
tendons. The first version of the hand used kevlar with dacron wound around it for tendon 
material, while the second and present version of the hand uses polyethylene (see Figure 
3.1 for a picture of the hand and Figure 3.2 for the hand arm system). 




Figure 3.1: Picture of the Utah-MIT hand. 

The hand comprises sixteen revolute joints, divided into four fingers each with four 
joints. Each joint is driven by 2 tendons routed over pulleys. The tendons are routed from 
the actuator pack which houses the actuators, to the hand's joints through a remotizer that 
allows the actuators to be located remotely relative to the joints. The hand can carry a 
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payload of about 15 pounds and it weighs about as much. 

Current sensing capabilities of the hand include two tendon tension sensors per joint and 
Hall effect angular rotation sensors, that enable the position of any joint to be measured 
accurately. 

The Utah-MIT hand has a number of novel features that make it one of the best robot 
hands designed to date. As mentioned earlier, the issues involved in the design of this hand 
have been presented in a series of papers by Jacobsen et al. [1984], [1985] and [1986]. The 
innovative features of this hand are summarized below: 

1. Each joint is driven by two tendons requiring 2n tendons to drive n joints. As a 
point of contrast, the Salisbury hand requires n + 1 tendons to drive n joints. The 
engineering tradeoff was between the added complexity of routing the extra tendons 
compared to the simplicity of the decoupling involved and the added power obtained. 

2. Each pneumatic actuator is driven by a modular valve design. The actuator essentially 
drives a graphite piston moving in a glass cylinder to which a tendon is attached. 

3. Compact Hall effect position and tendon-tension sensor designs. 

4. Polyethylene tendons that are strong and durable. 

5. Each finger comprises four degrees of freedom and there are four such fingers. The 
hand looks anthropomorphic since the design includes an opposing thumb and the 
axes of all the distal revolute joints are parallel, much like in the human hand. The 
size and shape of the various joints are also comparable to that of the human hand. 

A hand that cannot move about in a workspace is of little use. To facilitate the palmar 
plane to be moved around, a cartesian table was constructed on which the hand could be 
mounted. This table is a four degree of freedom robot. All four axes of the table are driven 
by stepper motors. The stepper motor controller uses electromagnetic sensing to determine 
the position of a stepper motor very accurately, and hence it is possible to operate the 
cartesian table without relying on feedback from devices like optical shaft encoders. Out 
of the four cartesian axes, two are oriented in the same direction, which facilitates tracking 
operations. 

The table was designed and built so that we would be able to position the hand in a 
workspace that was roughly a cube 18 inches on its side. 

All of the implementations and experiments that we are to describe were conducted on 
this robot. The computer architecture designed for it, however, is a truly general purpose 
real time development machine, and hence has been applied to control other robots like the 
MIT Serial Link Direct Drive Arm. 

3.2 Forward Kinematics 

The problem of forward kinematics, very simply put, is the problem of finding out 
the coordinates of the finger tips in cartesian space given the joint configuration as input. 
With dexterous hands, this problem is always well defined since most dexterous hands can 
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Figure 3.2: Picture of the Utah-MIT hand arm system. 

be represented by tree-like open-loop kinematic chains (see Salisbury [1982], Jacobsen et 
al. [1983] for examples of such designs). This is so because most robot hands today are 
manipulating devices that have many fingers (each with a number of joints) attached to 
some kind of wrist which in turn can be positioned in space by other joints and links. 
The forward kinematics problem can therefore be expressed as computing: 



x=/(0) 



(3.1) 



where x is the vector of finger tip locations expressed in cartesian space, and is a vector 
of joint angles. 

There are two reasons why computing the forward kinematics efficiently, is important. 

(a) As we will see later, some control algorithms depend on being able to compute the 
forward kinematics as a subproblem. In particular, force and position control algo- 
rithms that need to compute the position of a grasped object in cartesian space use 
forward kinematics computations extensively. Most of these algorithms assume that 
contact is made between a grasped object and the finger tips. Knowing the positions 
of the finger tips in cartesian space helps in determining the position and orientation 
of the grasped object. 

(b) The forward kinematics computation is an important part of a kinematic simulator, 
that could be used for a variety of purposes. 

There are many ways of solving the forward kinematic problem. Here I present two of the 
most widely used. The first method relies on what I call the modified Denavit-Hartenburg 
notation. 
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The Denavit-Hartenburg notation is perhaps the most widely used to represent the 
kinematic structure of robots. Briefly stated, it involves representing the transformation 
between two successive links in a kinematic chain (composed of revolute or prismatic joints) 
as homogenous transformation matrices. These matrices can be derived uniquely from the 
four so-called D-H parameters of the link, which can be described as follows: 

1. 6{ which represents the angle made by the i'th joint, 

2. a,- which represents the twist angle between the two axes of movement (these axes 
would be rotational if the axes were revolute and translational if the axis were pris- 
matic), 

3. a; which represents the distance along the common normal between the two axes, and 

4. di, the distance along the z,_i axis between the origins of the two coordinate systems. 

It must be pointed out that this notation is not unique, even for serial kinematic chains. 
In fact, when applied to tree-structured kinematic chains, this notation is ambiguous (see 
Khalil [1986] for an example of such a situation). Alternatives have been proposed by many 
to remedy this situation with respect to tree-structured and closed-loop kinematic chains. 
Sheth and Uicker [1971] propose a rather complex alternative wherein they separate the 
information pertaining to the shape of the link from the variable part that varies with joint 
motion. This notation is not only overly complex, but it is computationally quite expensive, 
as noted by Roth [1985]. 

It is rather easy to see that there are two basic ways of dealing with the ambiguity in 
the DH notation with respect to tree structured manipulators, and both have to do with 
the numbering scheme chosen to deal with branch-points in the tree-structured chain. A 
breadth-first numbering scheme would number the k joints attached to a joint n as n + 1, 
n + 2 ... to n + k. A depth-first numbering scheme on the other hand can be described to 
recursively compute the numbering as follows: 

joint_number( joint) 
{ 

number_of (joint) = no + 1 

no = no + 1 

for all sons of joint do 
joint_number(son_ joint) 
} 

One can see that this would result in a branch point at joint k being numbered as n + 1 
where n was the last number used in the previous serial chain encountered instead of k + 1 
as in the previous scheme. 

Once the ambiguity has been resolved, the same D-H matrices can be used to deal with 
tree-structured manipulator chains as before. 
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3.2.1 Forward Kinematics of the Utah-MIT Hand 

The Utah-MIT hand is a four-fingered dexterous hand. Each finger of the hand has four 
joints, making a total of sixteen degrees of freedom. As was mentioned earlier, the hand is 
mounted on a four degree of freedom x-y table. 

The structure of the arm must be factored into the forward kinematic calculations to 
determine the position and orientation of the finger tips. It was for this reason that a carte- 
sian design was chosen for the x-y table: namely, to simplify the kinematic considerations 
involved in dealing with the arm. Currently there is no way of measuring the orientation 
of the palmar plane relative to the z-axis. This deficiency is to be corrected shortly. 

While considering the forward kinematics problem, therefore, we will split the problem 
into two subproblems. First the position and orientation of the palmar plane will be deter- 
mined using the arm system. Then the position of the finger tips will be determined relative 
to the palmar plane. Notice that this procedure will extend to arbitrary tree structured 
kinematic chains rather trivially. The position and orientation of each node that forms a 
branching point when computed, allows the computation of the positions of joints further 
down the tree to be computed rather easily. 

The Denavit-Hartenburg parameters of the Utah-MIT hand are given in Table 3.1 1 . 
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Table 3.1: D-H Parameters for non-thumb fingers. 

The single thumb of the Utah-MIT hand is different from the rest of the hand's fingers. 
The Denavit-Hartenburg parameters for the thumb are given by Table 3.2. 
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Table 3.2: D-H Parameters for the thumb. 



Since each finger can be individually considered to be a robot affixed to the palmar plane, 



1 A more detailed derivation and explanation of the various coordinate systems used can be found in 
Appendix A, which also explains in detail the various symbols used. 
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one can use the final °As frame to describe the position and orientation of the finger tip 
relative to the palm. 

Notice also that in general, we might have a tactile pad mounted at the tip of the finger 
and hence the co-ordinates of the actual contact location will be expressed relative to the 
co-ordinate system of the final reference frame. This would mean that to derive the actual 
contact location in the palmar frame these co-ordinates have to be pre-multiplied by the 
°As matrix. 

We choose to describe the cost of these particular computations in terms of elementary 
operations like multiplications (denoted by M), additions (denoted by A) and transcen- 
dental function calculations (denoted by T) rather than the asymptotic analysis that is 
more common, since we desire to get a very detailed picture of the computations involved. 
Such an understanding is required to facilitate fast implementations operating in real time. 
Computationally, it would take 26M+16A+8T operations to compute all the elements of 
this matrix, which describes completely the position and orientation of a finger tip relative 
to the palm for a non- thumb finger. To compute the co-ordinates of a contact point relative 
to the palmar plane, an equal number of operations would be required. For three fingers 
therefore, a total of 78M+48A+24T would be required. 

For some computations, the entire matrix A$ need not be computed. If only the 
cartesian positions of the finger tips are needed for example, such information can be 
obtained with 12M+14A+8T operations. 

Since the thumb is kinematically simpler, it takes only 12M+9A-|-8T operations to 
compute the elements of the °As matrix (also known as the T matrix) for the thumb. 

The total number of operations required to solve the forward kinematics problem for 
the Utah-MIT hand's fingers is therefore given by: 

C(fkin) = 94M + 63A + 32T operations (3.2) 

3.3 Inverse Kinematics 

The inverse kinematics problem can be stated as that of computing the inverse of the 
mapping / mentioned in Equation 3.1. The problem is to find a configuration of joint 
angles given the cartesian coordinates of the end points of the finger tips as given by: 

9 = /- a x (3.3) 

This problem turns out to be, surprisingly, quite a hard one. This is because of the fact 
that while the number of joints in a manipulator is restricted only by physical constraints 
and perhaps by its designer's imagination, the cartesian space the manipulator operates in 
is the familiar three dimensional world that its tasks are performed in. This means that 
while six coordinates suffice to describe the cartesian or task space, the joint coordinates 
associated with robots can be considerably more in number. 

This is true especially of dexterous robot hands. The Utah-MIT hand has, for example, 
four joints on each of its four fingers, requiring sixteen joint angles to completely describe 
just the configuration of the hand (see Jacobsen et al. [1983]). The Stanford-JPL hand has 
three fingers with three degrees of freedom each (see Salisbury [1982]). This large number 
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of degrees of freedom present in dexterous hands means that the inverse kinematic mapping 
may not be well defined or there may be multiple solutions to choose from. The mapping 
/ _1 is not a function but is a one to many mapping. 

The inverse kinematic problem basically involves the solution of the non-linear equation 
expressed by Eqn. 3.3. 

3.3.1 Inverse Kinematics of the Utah-MIT Hand 

We will now consider the inverse kinematics of one finger of the Utah-MIT hand. The 
hand has four fingers, each of which has four degrees of freedom. Each finger is not equiv- 
alent to a full-fledged six degree of freedom robot and it will not be possible to specify 
the end point position and orientation of a finger individually. We do have control of four 
parameters however, and one can choose these parameters in a number of different ways. 
If we choose to specify end-point position in 3-space, we will have to provide as input to 
the trajectory planner the x, y and z coordinates of the finger tip and would still have one 
degree of freedom left over. Stated another way, a four degree of freedom finger will be 
redundant by one degree of freedom for this 3 degree of freedom positioning task. 

The question then arises as to how to use this extra degree of freedom. A number of 
researchers have investigated redundant arms and there have been many different proposals 
seeking to utilize this redundancy for the purposes of obstacle avoidance (Maciejewski 
and Klein [1985]), energy minimization (Liegeois [1977]), and joint torque optimization 
(Hollerbach and Suh [1985]). 

A number of local dexterity measures have been proposed to solve this problem and to 
aid in obtaining the solution to the inverse kinematics problem. Usually the problem is 
expressed in the velocity domain and the task is then to find the solution 6 from: 

x = J6 (3.4) 

where J is the Jacobian matrix. 

Usually, this is done by the following equation: 

6 = J+x+(I- J+J)z (3.5) 

where J + is usually some kind of generalized or pseudo inverse, and z is an arbitrary vector 
chosen to optimize secondary criteria. 

A number of different so-called dexterity measures have been proposed in the literature, 
as the appropriate secondary criterion to minimize or maximize. These include the deter- 
minant of the Jacobian, (Paul and Stevenson [1983]), the square root of J J T (Yoshikawa 
[1984]), the condition number of the Jacobian (Salisbury and Craig [1982]), the minimum 
singular value, and the joint-range availability index to minimize the possibility of the joints 
attaining their joint limits. Comparative studies between these numerous dexterity mea- 
sures have been rare (see Klein [1987] for an example), and even when performed have been 
largely inconclusive, since the purpose of each of the dexterity measures is different. 

Rather than use one of these studied approaches which treat the problem in the velocity 
domain, we will look at the problem in the position domain. We will call such methods for 
resolving the redundancy as direct methods. 
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Perhaps the simplest of all approaches is to treat one of the joint angles as fixed. Since 
the axis of rotation of the three distal joints of the Utah-MIT hand are parallel, fixing joint 
would be wasting a very important degree of freedom, one that changes the entire plane 
of operation of the distal links. Fixing the joint angle of any of the three distal joints, 
however, would enable us to reduce the finger to a 3 degree of freedom finger much like the 
fingers of the Stanford-JPL hand (the link that is considered fixed can be considered to be 
just a part of the previous link). This approach, while easy to implement and understand, 
makes no use of the additional degree of freedom and hence we will not concern ourselves 
with it any further. 

There are two other ways to address this question. Both involve the specification of an 
extra constraint equation or an extra parameter that can be controlled. To my knowledge, 
the direct specification of these constraint equations in joint space has not been explored 
in detail in the past. 

We propose two ways of specifying an extra constraint directly in joint space. Both 
ways are simple and result in compact equations. The need for simplicity at this level is 
motivated by the need to evaluate these equations in real time for certain operations. 

The first way to resolve the redundancy issue is to specify the endpoint orientation 
relative to the palmar plane in addition to the position information. Although this may 
seem equivalent to fixing one of the joint angles, it is different in that this added parameter 
can be specified and controlled meaningfully. The r.h.s of Equation 3.3 will then be a four 
by one vector involving three cartesian positions and one angle. 

To solve the resulting inverse kinematics equations, we first convert the x, y, z coordi- 
nates expressed in the palmar plane coordinate system, to the coordinate system affixed to 
the first link. This can be done simply by premultiplying the desired cartesian position by 
the 1 Ao matrix. For non-thumb fingers this matrix can be found out from °Ai~ X which is 
given by: 



X A 






1 


-r p 


sin(<f> p ) 





cos(4> p ) hp cos((/>p) — l p sin(<f>p) 


cos{<t> p ) 





—sin(<j>p) tan(<f>p)[lp sin(4> p ) — h v cos{4> p )] 








1 



(3.6) 



Once the coordinates have been converted to be in this coordinate system, joint angle 
#o (or the joint angle of the proximal link attached to the palm) of each finger can be 
determined simply from 

#o = arctan(y/x) (3.7) 

We still have to determine the three remaining joint angles. Now that we know angle 
9q, we can as before express the coordinates relative to a frame affixed to the next distal 
joint. Since the axes of the three most proximal joints in each finger are parallel to one 
another, the problem is now essentially that of deducing three joint angles given the x,y 
position of the finger tip, in this plane of operation. 
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The inverse of the second matrix is given by 2 Ai, which is equal to 1 A2 



-1 



2 



A* = 



Co So -/o sin(<j> ) 

0-1 i co^o)+ lp - 



cos(<f> p ) 
-So Co 

1 



(3.8) 



If we let the orientation of the final link be fixed at some angle Of , (which can be com- 
puted either relative to the palm or as a function of the path during trajectory execution), 
we can see that what we have is essentially the familiar two degree of freedom problem, 
where 

%t = %d- h cos(0j) , . 

Vt = Vd- h sin(0f) 

and (x<i, yd) are the co-ordinates of the finger tip after the multiplication expressed by 
Equation 3.8 has been made. 

Given xt and y t we can compute the angles 9\ and 62 using the familiar formulae given 
below. Note that the kinematic structure of the Utah-MIT hand's fingers prevents the 
attainment of what is normally called the elbow-down (or curling out) configuration, and 
therefore there is only one solution possible for this reduced two degree of freedom problem. 



02 = acos 



x t + y t — /j — «2 



2/1/2 J 

0\ = atari ( — I - atari [ - — -, \— -r ) 

03 = Of -(0i + 02) 
The condition for reachability for the two degree of freedom problem can be given as 

V / z? + 2/t 2 <(*i+/2) (3.11) 

Notice that the angle that the finger tip makes with the palm has been assumed to have been 
specified in the plane of operation of the three distal joints. This may not be necessarily 
true. It is more realistic to expect this angle be specified as a vector that is perpendicular 
to the surface of the finger tip. Going from this latter or any other representation of this 
angle to its projection on the plane perpendicular to the axes of revolution of the three 
distal joints is usually quite simple. 

The effect of choosing this way to resolve the redundancy is illustrated in Figure 3.4, 
which simulates a horizontal trajectory directly above the palmar plane. Notice that the 
orientation of the distal link relative to the palm remains fixed throughout the entire motion. 
Figure 3.3 illustrates the consequence of the same assumption on a vertical trajectory. 

Keeping the orientation of the last link fixed is not the only possibility. One could vary 
this orientation as a function of the trajectory to be executed. Such a capability could be 
used for example in manipulating objects with known shapes, for it allows a precise control 
over the locus of the contact point on the finger tip surface. 
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Figure 3.3: Vertical trajectory using fixed orientation constraint. 




Figure 3.4: Horizontal trajectory using fixed orientation constraint. 

Another approach to resolving the redundancy was motivated partly by the observation 
that in human fingers the angles made by the two most distal joints remain approximately 
equal throughout the course of a motion. This is essentially the specification of an extra 
constraint equation of the form 



3 = Kx 02 (3.12) 

where K is some proportionality constant. Setting K to 1 specifies that the two angles are 
equal. 

Using a constraint equation of this form (where K=l), one can rewrite the kinematic 



§3.3 Inverse Kinematics 29 

equations and solve for the inverse kinematics as follows 2 . 
We first note that: 



x d = h cos{6 x ) + h cos(e 1 + 2 ) + h cos(6 x + 2 + #3) 
y d = h sin(0 x ) + l 2 sin^ + 2 ) + h sin{0 x + 2 + Z ) 



(3.13) 



Squaring the above equations and adding, we get: 

'i 2 + l\ + ll + 2 h h cos(0 2 ) + 2/2/3 cos(6 2 ) + 2/1/3 cos(2 6 2 ) = x 2 d + y 2 d (3.14) 

Using the double angle formula for the cosine, we can see that the above equation reduces 
to a quadratic in 2 . 

4 h l 3 cos 2 (0 2 ) + 2 (h l 2 + l 2 l z )cos{0 2 ) - (x 2 d + y j-ll-q-ll + 2hl 3 ) = (3.15) 

This quadratic equation can be solved for the value of cos{0 2 ) rather easily. Again, because 
of the kinematic structure of the Utah-MIT hand's fingers, only one of the solutions is 
possible. Since K equals 1 in the above example, 9$ is equal to the above value of 2 . The 
last remaining joint angle can be found from: 

* = atan ( y -±) - atan (, h f^j [ + >> «« 2 %\ A (3.16) 

\x d J \h + l 2 cos(0 2 ) + h cos(2 2 ) J v ' 

This way of resolving the redundancy certainly results in different joint angles for the same 
cartesian finger tip positions. 

The effect of this method is illustrated on the horizontal and vertical cartesian space 
trajectories as before in Figures 3.5 and 3.6. Besides having a human-like graceful motion, 
the second method offers the advantage of a larger workspace in certain regions. This can 
be seen from the fact that the first method essentially reduces the workspace to that of 
a two-degree-of-freedom revolute manipulator augmented ellipsoidally by the length of the 
third link. In regions of the work space where the fixed-orientation requested is parallel 
to the orientations of joints 1 and 2, the trajectory planner is limited by the fact that it 
cannot use the third link very much. 

Figure 3.7 shows a diagonal linear trajectory using the second method, which illustrates 
the large workspace attainable. The curling motion of the fingers during such a motion could 
be useful for acquisition operations as we will see later. 

On the other hand, the vertical trajectory illustrates a disadvantage of the second 
method. If the trajectory had been computed attempting to move a grasped object one 
can see that as the motion begins at the top, the finger's joints are clear of the object. But 
as the finger moves progressively down, the distal joint would attempt to actually move 
into the object. Depending on the stiffness of the grasped object and the finger servos, this 
could result in large forces of interaction. 



2 I have shown the derivation only for the last three joint angles. The derivation for #o remains the same 
as before. 
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Figure 3.5: Vertical trajectory using equal angles constraint. 
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Figure 3.6: Horizontal trajectory using equal angles constraint. 



One would like to quantitatively measure the difference between these different ways 
of choosing the extra constraint equation. The norm of the joint-angle differences and the 
difference in arc length along the homogenous solution path have both been proposed as 
possible measures that could be used for this purpose in a recent paper (Klein [1987]). While 
it is true that such measures do indirectly measure other desirable features of trajectories, 
intuitively one finds it troublesome that in all recent attempts to compare and measure 
the effects of these different measures no importance is given to the task to be performed. 
No attempts have been made also to judge the different performance measures over widely 
different areas in the workspace and through widely different trajectories. Daunting as such 
a task may be, a principled approach to such evaluation may yield lasting results. 



§3.4 Other Issues 



31 




Figure 3.7: Linear trajectory using equal angles constraint. 

One must also mention that the second method of specifying an extra constraint equa- 
tion raises other interesting possibilities. In some cases, configuration space planners rely 
on taking what are known as slices of the configuration space (see for example Lozano-Perez 
[1986]). This usually involves fixing one joint angle and looking at the range of orienta- 
tions possible for the other joints. Stated another way, these planners sweep a generalized 
hyperplane through configuration space, one that is perpendicular to some axis of the con- 
figuration space. Critical slices are those slices at which the topology of the configuration 
space changes drastically. It is important for a planner to at least find all such critical 
slices, since otherwise it could fail to recognize the presence of an obstacle between two 
slices (see Erdmann and Lozano-Perez [1986]). The specification of constraint equations as 
above illustrates the notion that slices can be taken of the configuration space in other ways 
besides the usual. While we have used this constraint to determine a slice where in the 
problem of inverse kinematics becomes solvable, the advantages of such slices with respect 
to detecting critical slices still remain largely unexplored. 



3.4 Other Issues 

As we mentioned earlier the Utah-MIT hand is mounted on a cartesian table with a 
simple kinematic structure. Mounting the hand on such a device however raises other issues, 
which I can only briefly mention here. 

The first of these has to do with how end-points are specified in conventional robotics. 
The usual way end point configuration of a robot is specified is through a homogenous 
transform or some other representation that provides information as to the cartesian loca- 
tion (in x,y,z) and orientation of the end point. In the case of a dexterous robot hand, 
one has not only to provide this information for an arm, but in addition the end-point 
positions of the various fingers that make up the hand. But providing information as to 
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where each finger tip is located throughout a trajectory may be overly wasteful. What 
one needs instead is a decoupling between the hand's kinematics and the arm's kinematics 
where possible. This decoupling however is a function of the task to be performed and 
hence only heuristic decompositions may be possible. In a pick and place operation, for 
example, we can obviously exploit the fact that we do not expect to move the hand's joints 
during certain parts of the motion trajectory. 

In the case of anthropomorphic hands like the Utah-MIT hand mounted on a six degree 
of freedom robot, there is a natural decoupling between the wrist's positioning and the 
positioning of the finger joints. However, this may not be the case if either the hand gets 
more complex or if the arm gets simpler. 

Another thorny issue is determining when to move the hand's fingers and when to move 
the arm. We mentioned earlier that one of the advantages in using a dexterous hand is 
that for small incremental motions, one needs to move only the fingers associated with the 
hand and not the entire arm. However, it seems intuitively obvious that for larger motions 
we would prefer to move the arm rather than the hand. In practice, one thumb rule that 
could be used is for motions larger than the size of the hand itself, the arm should be used. 
However, if one is to use the higher bandwidth available at the hand's finger level, more 
intelligent ways of partitioning the motion must be considered. 

Workspace questions are usually harder to pose and answer even for conventional robots. 
They are even more so for dexterous hands. During the motion of a robot hand, one must 
make sure that none of the fingers collide with one another, or with the grasped object 
in a fashion that would cause the task to fail. When one holds an object, which is small 
relative to the size of one's hand, it is easy to see that one can manipulate it far easier 
over larger regions in the hand's workspace than if one were holding a large object. This 
rather complex interaction between the shape of a grasped object and the kinematics of 
the hand's fingers proves to be a rather interesting area where much fruitful research can 
be expected in the future. 
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This section will present a hierarchical controller that has been implemented to run under 
the multiprocessor architecture to be described in a later section. There are a number 
of ways that a complex device like the Utah-MIT hand can be controlled. Each way 
of controlling the hand has its own advantages in terms of convenience and performance 
relative to a particular task. 

The controller is hierarchical in that there are many control loops each of which im- 
plements a particular input output relationship. One of the important advantages of the 
computational architecture to be described in a later section is the ease with which the 
addition of such control loops can be done. 

The choice of the hierarchy is partly dictated by the necessity to separate different levels 
of abstraction. The highest level needs necessarily to operate in object space (or task space). 
Subsequent levels of the hierarchy move lower toward the actuator space. For example, if 
the highest level controlled a grasped object's cartesian position, intermediate levels could 
involve the computation of finger tip cartesian positions and joint angles corresponding to 
these tip positions. A lower level then could compute tendon tensions from these joint angles 
and the last level in the hierarchy would actually compute the actuator voltages needed to 
achieve these tendon tensions. It is interesting to note that a similar hypothesis has been 
proposed for how human movements are formulated (see Hollerbach [1982]). In fact, one 
finds that the hierarchy proposed by Hollerbach [1982] comes very close to describing how 
the hand controller hierarchy operates. 

In this and subsequent sections, the different spaces in which the controller operates are 
outlined along with the algorithms implemented by each level. This section is not intended 
to cover design aspects involved in synthesizing a digital controller. Such information is 
more easily found in a number of texts devoted to the subject (see for example Astrom and 
Wittenmark [1984], Ogata [1987]). Rather, this section is intended to provide a flavor of 
how such low level computations are structured by using the Utah-MIT hand as a concrete 
example. 

All the implementations to be described below are fully digital implementations. There 
are many reasons for leaning toward a digital implementation, foremost amongst which are: 

(a) In most cases, the hardware can be made simpler. 

(b) Digital controllers do not exhibit troublesome features such as drift, electrical nonlin- 
earities, etc., that are usually associated with analog components. 

(c) They are flexible, and allow fast prototyping and testing of different control algo- 
rithms. 
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(d) They need not necessarily mimic their analog counterparts and can indeed use special 
algorithms for nonlinear compensations and dead-beat control that have no counter- 
part in the analog domain. 

4.1 Tendon Management 

The controller was designed using a layered approach proceeding from the bottom 
(which is the lowest level of control) to the top. At the lowest level, tendon manage- 
ment issues predominate. At this level the controller servos tendon tensions associated 
with a particular actuator. 

In most robots, the lowest level of the controller has been termed the actuator level, 
and the space in which the controller operates the actuator space (see Craig [1986]). In 
conventional robots driven by electric motors, this would be the level that would, for ex- 
ample, convert joint torques to currents or voltages. Since the Utah-MIT hand is driven by 
pneumatic actuators and tendons, the ultimate variable controlled by the lowest level of the 
controller is the tendon tension associated with an actuator. (In practice, there may or may 
not be one further level of control beneath this level of digital control, usually associated 
with the amplifiers controlling the actuator). The important variables associated with this 
level of the controller are the tendon tension loop gain, the co-contraction level, and the 
rectification function, which will be described shortly. 

The tendon space controller has to be extremely simple so that it can be run extremely 
fast. A simple P, PD or PV controller is usually good enough at this level. 

Physically speaking, tendons can only be pulled and not pushed. Hence it becomes 
necessary to rectify the desired tendon tension, so that it is always positive. There are 
many ways of doing this rectification. Jacobsen et al. [1983] mention the possibility of 
using an exponential function to perform the rectification. In practice, the complexity of 
implementing a non-trivial rectification function is not commensurate with the benefits it 
brings in terms of performance. Hence, we decided to use a simple rectification scheme 
pictured in Figure 4.1. 

In practice, deciding what levels of co-contraction should be used is non-trivial. For 
fast operation, the non-linear nature of the system tends to make co-contraction similar 
to active damping - i.e., the higher the co-contraction, the higher the damping. After 
experimenting with various ideas on dynamically varying the co-contraction, it was decided 
to keep it constant at a level which would permit smooth operation over a wide range of 
speeds. 

4.2 Joint Level Control 

To develop the next level of the controller, I used a simple second order model of the joint 
in simulations 1 . With the underlying tendon space controller operating at high sampling 
rates (see Page 45 for performance information), it becomes possible to treat the lower level 
as a simple second order system for the purposes of higher level control. 

Most of the simulations were performed using MatrixX, a control package developed by Integrated 
Systems Inc. 
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Figure 4.1: Rectification function. 



In this section, we will assume that our purpose is to do position control (i.e., the 
controller will take as input joint angles and output actuator space commands - in the case 
of the Utah-MIT hand this output will be desired tendon tensions). 

Figure 4.2 shows the step response of the underlying joint, which is modeled as a 
continuous time system. The step response of the actual system after the controller has 
been tuned appropriately is shown in Figure 4.3. 

To understand the final form of the controller, it is illustrative to begin with a simple 
form of what we would like to achieve in terms of position control: 



M p = K p x A0 



(4.1) 



where M p is the torque to be exerted about a joint and is proportional by some gain K p 
to the position error A6. 

Note that the simple form given by the above equation does not take into account a 
number of factors, but is extremely easy to understand. It simply produces a restoring 
torque in order to reduce positional error. The task before the joint angle controller is 
now to convert this restoring torque (called t p to indicate that it is a position torque) into 
actuator space commands. 

To illustrate how this is done, consider the simple single joint shown in Figure 4.4. The 
torque about the joint can be written as 



T = (T f -T e )xr 



(4.2) 



where Ty stands for the flexor tension, T e stands for the extensor tension and r stands 
for the pulley radius. Notice that this equation implies that if we need to solve for tendon 
tensions from torques, we have two unknowns but only one equation. However, if we assume 
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Figure 4.2: Step response of the model. 
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Figure 4.4: Picture of a single joint controlled by 2 tendons. 



that the two tensions will be symmetric about the co-contraction point T c , we can write 

(4.3) 



Tf = T c + Tdi/f 
T e = T c — Tdijf 



Putting these two equations to gether we can see that 

r 



T diff = 



r x 2 



In practice, we would like to augment equation 4.1 with a factor depending on the 
velocity of the joint as given by 



M p = KpXAfl + K v x A0 



(4.4) 



An integral term based on the position error is also used in the actual implementation 
to improve the steady state error. A plot of the tendon tensions generated by the controller 
using the modified equation, for the step response pictured earlier, is shown in Figure 4.5. 
Since we do not have a way of directly measuring joint angle velocities in the Utah-MIT 
hand, we rely on using the first difference of joint positions as an estimate of the velocity. 
More complicated ways of estimating the velocities and using them in the control equation 
could also be implemented. 

The plot does not include co-contractions, which would just shift the entire graph along 
the y-axis. Notice, however, that the plots indicate a non-synergistic interaction between 
the actuators. A more synergistic interaction occurs if instead of summing the position 
and velocity torques and then computing the tendon tensions from this summed value, we 
were to apply the rectification function on each of the individual torques and then sum the 
resulting tensions. 
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Figure 4.5: Tendon tensions generated. 



The equation for this would be: 

T = Rect(K p ) + Rect(K v ) + C 



(4.5) 



instead of the earlier 



T = Rect(K p + K„) + C 



(4.6) 

A plot of the tendon tensions produced by such an equation is shown in Figure 4.6. The 
plot of actual tensions generated by the controller (which takes into account a coupling 
effect discussed next) is shown in Figure 4.7. 

4.3 Finger Level Control 

The finger level controller needs to take into account the coupling between the various 
joints. Since there are two tendons per joint and since the hand is tendon driven, the 
tendons for the distal joints must pass over pulleys installed in the proximal joints. This 
means that there is coupling between the motions of the proximal joints and the distal 
joints. This can be seen from a simple two jointed example as shown below (see Figure 
4.8). 

In practice, the effect of this coupling is rather noticeable. Figure 4.9 demonstrates that 
while joints 1 through 3 of a finger are moved, joint 3 actually seems to move backward 
before it recovers and moves forward. Obviously, when the ranges of motion are large, the 
excursions become larger. 
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Figure 4.8: Simple 2-joint example. 
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The coupling manifests itself in two ways. Firstly, when a proximal joint is moved, the 
tendons associated with a distal joint move. Thus, in order to keep a distal joint at the 
same joint angle relative to a proximal joint, it becomes necessary to introduce decoupling 
explicitly into the controller. The other way this decoupling can be observed is in the force 
domain - i.e., a torque exerted at the distal joint will mean that the same torque gets 
exerted at the proximal joint too. 

For the Utah-MIT hand, we can write the torques exerted at the joints as: 
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(4.7) 



or 



RT 



where r; refers to the radius of the pulley at the /'th joint, r t - refers to the torque exerted 
at the i'th joint and Tfi,T e i represent the flexor and extensor tensions associated with the 
i'th joint. 

Notice that since the axes of the distal three joints are parallel to each other, and move 
the finger in a plane that is perpendicular to the first joint's axis of rotation. The joint 
level controller developed in the previous section gives us a set of joint torques to exert 
about the joints. If one uses Equation. 4.3 to compute tendon tensions we would have 
"independent joint control". In practice, however, the coupling expressed by the equation 
given above needs to be taken into account. 

The inversion of the above equation (since we need tendon tensions from joint torques) 
could be done with pseudo-inverses: 

T = R+r (4.8) 

where 

R+ = R T (RR T ) -1 

Such an expensive computation can be avoided if we choose to resolve the redundancy by 
making the tendon tensions symmetric about a co-contraction level (as we did in Equation 
4.3). With this assumption, we can solve for the tendon tensions as: 

T c4 + r 4 /(2r 4 ) 
T c4 - r 4 /(2r 4 ) 
T c z + r 3 /(2r 3 ) - r 4 /(2r 4 ) 
T c3 - r 3 /(2r 3 ) + r 4 /(2r 4 ) 
T c2 + r 2 /(2r 2 )-T3/(2r 3 ) 
T C 2-T 2 /(2r 2 ) + r 3 /(2rz) 
Tei + Ti/(2ri) 
T cl -r 1 /(2r 1 ) 



TfA 

T e4 
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T e z 
T}2 

T e2 
Tfi 



(4.9) 
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It can be seen that the relationship between tendon velocities and joint angle velocities 
(or the differential movement relationship), and the relationship between joint torques and 
tendon tensions is not unlike the relationship expressed conventionally by the Jacobian. 
Recall that the Jacobian expresses a mapping between joint angle motions and cartesian 
motions given by 

x = 39 (4.10) 

and relates joint torques to cartesian forces by 

r = J T f (4.11) 

The mapping expressed by the R matrix performs a similar function since one can write 

T v = R r • 9 (4.12) 

where T v is a vector representing tendon velocities. 

Notice that the columns of this matrix can be easily written down if one uses the 
differential form of this second relationship. 

AT X = R T • A0 (4.13) 

which clearly indicates that if one keeps all the joints fixed and just moves joint i, the 
corresponding tendon displacement vector AT X will provide the i'th column of the R 
matrix. 

The mapping specified by Equation. 4.9 is relatively straightforward to compute. We 
could consider the mapping expressed by the matrix R as being composed of two matrices 

R = R] R2 

where R2 is a 4 X 4 matrix that performs all the decoupling necessary and Ri is a 8 X 4 
matrix that computes tendon tensions from these decoupled torques using the straightfor- 
ward single-joint model. Rewriting terms one can express: 



R 2 = 



Multiplying the torque vector with this matrix would give us a matrix of decoupled 
torques which can then be used to compute the tendon tensions from: 
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where the subscript i has been used to indicate that the values refer to the t'th joint, and 
tjc refers to the decoupled torque. 



§4.3 Finger Level Control 



43 



c 
o 

I 

c 
o 

'•fr-J 

w 

8. 



1500 



1000 - 



500 - 



-1500 c 




_L 



I 



_L 



J_ 



_L 



J 



550 ; 600 650 700 750 800 850 900 950 1000 



-500 -- - 



-1000 r 



Joint 
Joint 1 
Joint 2 
Joint 3 



time (1/300s) 



Figure 4.10: Decoupled step response. 



The controller expressed by Eqn. 4.4 can be replaced therefore by: 

M p = R 2 • (K p xAS + K v x A0) 



(4.15) 



In reality, the decoupling matrix should include dynamic effects that depend on the 
configuration of the joints and their velocities. Expressing such a complex functional de- 
pendency would make the controller more complex, and hence we choose to neglect the 
dynamic effects and concentrate only on the static coupling that exists (see Biggers et 
al. [1986] for one such attempt at including such effects in the off diagonal terms in the 
decoupling matrix R2). 

In our current implementation we have found that the static decoupling matrix works 
rather well. We have provided for a weighting matrix R 3 in addition which uniformly scales 
the effect of this decoupling, but in practice this matrix has always been set to the identity 
matrix. The actual step response output after setting the decoupling matrices appropriately 
is shown in Figure 4.10, and the effect of the decoupling matrix in the calculation of the 
torques is shown in Figure 4.11. 

We now have derived a controller that takes as input joint angles and then computes 
at the first layer the joint torques needed to achieve the given joint angles. These joint 
torques are then translated to tendon tensions and servoed by a tendon management servo, 
after the necessary decoupling and co-contraction levels have been added. Such a controller 
can be used to directly execute joint-space trajectories. Besides joint angles we could also 
choose to specify joint torques. The force control algorithm described in the next chapter 
relies on directly computing joint torques. Structuring the lower level of control in the 
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Figure 4.11: Decoupled torques. 

fashion described above allows us the flexibility of operating in force control or position 
control modes. 

To summarize therefore, as far as a higher level control loop is concerned this level of 
the control loop can be viewed as a functional box that looks like the one shown in Figure 
4.12. 
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Figure 4.12: Joint controller as viewed from a higher level. 
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Task Assignment 


Speed 


4 Joints/Processor 


283 Hz 


4 Joints/Processor + A/D,D/A 


192Hz 


2 Joints/Processor 


560 Hz 



Table 4.1: Performance of the Finger Level Controller - Version I. 



4.4 Implementation Issues 

We have implemented the hierarchical controller outlined above on two different archi- 
tectures. In this section we will discuss a few of the issues relevant to implementing such a 
hierarchical controller. The performance of the two implementations is also described. 

Since the two levels of the hierarchy mentioned above (namely, the tendon space level 
and the joint level) are interwoven and have data, dependencies between them, our imple- 
mentation assigns the so-called finger-level controller to a specific processor. The compu- 
tational architecture designed to implement such control hierarchies is outlined in a later 
chapter. The important points are that the task is broken up at the finger level and the 
assignment of tasks to processors is made at compile time and not dynamically. 

In the first implementation on the Motorola 68000 based single-board computer, one 
finger was assigned per processor. In Version II, based on the Motorola 68020 based single 
board computer, two fingers were assigned to a single processor. The performance of the 
implementation on the Version I hardware is shown in Table 4.1. 

In our first implementation, it was found experimentally that reading and writing the 
A/D and D/A converters was time consuming. Hence we moved this task to a separate 
processor. In Version II, the control processors are fast enough to service the A/D and 
D/A conversions as well. 

As can be seen from Table 4.1, reading the analog-to-digital converters and writing to 
the digital-to-analog converters alone takes approximately half the time in the feedback 
computation. The performance of the second implementation is indicated in Table 4.2. 
The last row in this table indicates that the performance of the current implementation 
is adequate for tracing and monitoring functions as well. In all previous implementations, 
adding such functionality slowed the performance of the servo loops considerably. Both the 
two implementations use scaled integer calculations for their control loop computations. 



4.5 Higher Level Control 

The next level of control forms the highest level in the current control hierarchy. There 
are different ways of implementing this level, and a number of different choices that have to 
be made in the process. Since this level directly interacts with the joint level controller, it 
is clear that the output of this level should be either a sequence of joint angles (as is usually 
associated with position control), or a sequence of joint torques (as is usually associated 
with force control). We will first deal with the issues associated with pure position control 
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Task Assignment 


Speed 


8Joints/Processor 


550 Hz 


8 Joints/Processor + A/D,D/A 


390Hz 


8 Joints/Processor + A/D,D/A + Tracing 


340Hz 



Table 4.2: Performance of the Finger Level Controller - Version II. 



in this section. Issues devoted to force control will be addressed later. 



4.5.1 Hand Primitive Motions 

We will first deal with what I like to call open loop object level control. In this type 
of control the position and orientation of a grasped object is controlled with little or no 
feedback. The idea is essentially to specify co-ordinated motion of the finger joints relatively 
independently, without worrying too much about the interaction between the finger joints 
and a grasped object. This style of control follows mainly from the approaches outlined in 
Mason [1982] and Fearing [1983]. 

The motivation for this approach stems from the observation that stated in very abstract 
terms, a grasping operation can be specified as follows: 

1. Open the hand's fingers wide in anticipation of the grasp operation to be executed. 

2. Execute a series of moves that take the hand and arm to a pre-grasp configuration. 

3. Execute a grab or close operation at the end of which the object that is to be grasped 
will be stably positioned within the hand. 

Clearly, each one of the above steps involves the specification of a number of parameters. 
For example, in the first step, one needs to know how far apart the fingers need to be 
moved. The termination conditions for the second and third steps may also not be easy 
to specify, since they may depend on objects in the environment. We envision that given 
a task description and a model of the environment, one should be able to compute a 
series of parametrized trajectories that fill in the details involved in a co-ordinated motion 
template suggested by the above framework. As an example of such a parametrized grasping 
operation I have included a short program segment that illustrates how a chess piece can 
be picked up: 

pick_piece_at(x, y, piece.height , piece.radius) 

int x, y; 

float piece.height; 

float piece.radius; 

{ 

float tablex, tabley, closeval; 
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cvt_chess_to_table(x, y, fetablex, fctabley) ; 

if(tablex != otablex I I tabley != otabley) { 

move_table_xppriority(tablex, tabley, CHESS_FINAL_HEIGHT, 1000); 

traj_go_background() ; 

traj_wait(STEPPER_ONLY) ; 
} 

closeval = 2.0 * piece_radius; 

/* Open the Hand */ 

pcd_execute (GRASP, -(closeval), 1000); 

/* Move hand down */ 

move_table_xppriority(tablex, tabley, piece.height, 1000); 

traj_go_background() ; 

traj_wait(STEPPER_ONLY) ; 

/* Now perform closing operation */ 
closeval = 1.0 * piece.radius; 
pcd_execute(GRASP, closeval, 1000); 

/* Move hand up */ 

move_table_xppriority(tablex, tabley, CHESS_FINAL_HEIGHT, 1000); 

otablex = tablex; 

otabley = tabley; 

traj_go_background() ; 
traj_wait(STEPPER_0NLY) ; 



The function pcd.execute performs the critical co-ordinated motion of finger joints, 
and in this section we deal with the specification and development of such primitives. 
The advantages associated with such an approach include: 

1. The primitives form pre-compiled routines that can be used to accomplish a task 
quite easily. Since primitives can include other primitives and can be built up over 
time, they ease the task of a robot programmer. 

2. Parametrised trajectories have been found in practice to be surprisingly robust in 
the presence of object and environment uncertainties, and in the acquisition and 
grasping of objects. In fact, open loop control essentially means that the final position 
of a grasped object within the hand may not be known, and hence sophisticated 
manipulation operations that require such detailed information may not be possible. 
Planning such operations so that they are guaranteed to succeed is a difficult problem 
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Primitive 


Fingers affected 


Joints Affected 


CLOSE 


0[+],l[+],2[+],3[+] 


1 


CURL 


0[+],l[+],2[+],3[+] 


2,3 


CUP 


l[+],3[+] 


1 


SPREAD 


l[+],3[-] 





GRASP 


0[+],l[+],2[+],3[+] 


1,2,3 


TWIST 


l[+],3[-] 


1 


THUMB 


0[+] 





WAIT 


All 


All 


RESET 


All 


All 


START 


All 


All 


SINGLEJOINT 


Specified 


Specified 



Table 4.3: Hand primitive operations. 



and requires a sophisticated knowledge of both the environment and the grasped 
object (see Brost et al. [1983]). 

In practice, using this type of control, we have been able to perform a number of 
demonstrations by using a higher level loop wherein the success or failure of an attempted 
operation is indicated to the control loop. The Utah-MIT hand's kinematic structure that 
resembles the human hand also makes it easier to define such primitives and actually use 
them in tasks. 

The specification of such motion sequences would be verbose if the position trajectory 
of every joint needed to be specified. To avoid this, we have chosen to specify the co- 
ordinated movement of a number of joints via so-called hand motion primitives. Hand 
primitives are essentially a way to avoid specifying a large numbers of joint parameters 
repeatedly. To grasp a cylindrical object, for example, the simultaneous movement of many 
of the hand's joints is required. Conventional approaches of using a teach pendant would 
be hopelessly tedious for programming sixteen joints. Some researchers have proposed 
using a master/slave system and then operating hands in a teleoperative mode. While 
this suggestion is not without merit, some rather complex problems have to be overcome 
to make such a master/slave device. The problems are further compounded by hands 
with non-anthropomorphic kinematics, where the mapping between the master and slave 
is non-obvious and may require considerable operator training. 

These primitives provide a way of treating entire sets of joints as a single controllable 
entity. Some of the implemented hand primitives are shown in Table 4.3. 
The table is by no means meant to be all-inclusive since the user has the ability to define 
his own primitives. Primitives can be classified into two categories. 

1. Servo Level primitives that affect the performance of the control hierarchy by changing 
the servo parameters (these primitives have not been mentioned in the table). 
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2. Joint Subset Level primitives that affect some given subset of joints of the hand. 

Each entry in the table above specifies a primitive and the corresponding joints affected 
by that primitive. For example, the THUMB primitive specifies a motion that is to be ex- 
ecuted on joint zero of finger zero, in the positive direction. The TWIST primitive causes 
joint number one of fingers one and three to move in opposite directions simultaneously. 
Servo level primitives can likewise be specified for subsets of joints. Thus a primitive es- 
sentially specifies a co-ordinated motion of a chosen subset of joints. A primitive is not 
considered to have finished executing until all the joints it affects have moved to their final 
positions as required by the primitive's single argument. In a conventional robot program- 
ming language these primitives could be implemented as a series of MOVE statements. 

The primitives and the names chosen for them are not important. However, what should 
be noted is that by treating a number of joints to be controlled as a single parameter, a 
large amount of the complexity involved in programming the hand can be overcome. 

In the current implementation, these hand motion primitives have been extended to 
form a sort of threaded-interpreted language in which the hand can be programmed. The 
user can define his own primitives by specifying a name, a set of joints that the primitive 
affects and the direction of motion associated with each of those joints. At the hand 
primitive level we have implemented a motion editor that allows one to define and operate 
on entire sequences of hand primitive motions, much like one would operate on pieces of text 
in a conventional text editor. Using this editor one can enter sequences of hand primitive 
motions which can then be stored and retrieved from files. 

A sequence of motions, once programmed and tested, can itself be treated as a prim- 
itive in other motions, enabling the stringing together of long and complicated motion 
sequences. 2 

Given below are two short examples of such motion sequences, both of which were 
developed interactively to perform simple tasks: 

01. START(+00) 02. WAIT(+05) 03. SPEED(+10) 
04. GRASP (-40) 05. WAIT(+05) 

The first sequence is an example of a simple grasping operation. As mentioned before, since 
the hand is controlled completely as a position controlled device, the sequence succeeds in 
grasping cups or coke cans by relying on the passive compliance provided by the underlying 
mechanical device. 

The second example given below is performed after the hand has successfully grasped 
a pair of scissors. When executed, the sequence simulates a cutting action. 

01. CURL (+10) 02. WAIK+05) 03. CL0SE(-40) 

04. WAIT(+05) 05. CL0SE(+45) 06. WAIT(+05) 

07. CL0SE(-45) 08. WAIT(+05) 09. CL0SE(+45) 

10. WAIT(+05) 11. CL0SE(-45) 12. WAIT(+05) 

2 Since sequences of primitives can themselves be treated as primitives, it becomes necessary to do a full 
topological sort of the sequences before they are written out to a disk file. My approach to solving this 
problem was essentially gotten from a hierarchical editor called HPEDIT for doing VLSI circuit layouts which 
maintains a hierarchy of component circuit cells in disk files. 
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Notice that other ways of programming the hand would involve specifying a trajectory for 
each of the joints in a more tedious way involving end points and via points. 

Both the above examples did not use any servo-level primitives to change the servo 
characteristics as they were being executed. It is easy to see, however, that by judiciously 
altering the servo parameters like gain and damping, the performance of the hand can be 
altered during the course of a motion sequence. This is useful for changing between the 
two extremes of performance achievable with the hand, namely, that of force accuracy and 
positional accuracy. 

It must be mentioned that these motion sequences are parameterizable in terms of speed. 
This is so because each primitive motion actually causes a series of joint level trajectories to 
be enqueued. The trajectory generator then uses a simple joint level interpolation scheme 
(linear, quadratic and sinusoidal interpolation are the three types of interpolation schemes 
presently supported), to generate the sequence of joint angles that the lower levels in the 
control hierarchy must servo to. The linear interpolation is given by the equation 

Od(t) = 0i + t(0 f -0i) (4.16) 

where t ranges from to 1, with a specified step size tk. This step size is what is altered by 
the SPEED primitive. By increasing the step size the same primitive motion is performed in 
a shorter time. The actual time it takes for the primitive motion to complete, of course, is 
a function of the servo rate and is given by: 

tprim = Z T ( 4 - 17 ) 

servorate x tk 

It should also be noted that this type of control can co-exist with the cartesian position 
and force control schemes to be described later. 

4.5.2 Cartesian Space Control 

While hand primitives and other such schemes of open loop position control of the joints 
do accomplish a wide variety of tasks, these suffer from the disadvantage that they fail often 
owing to a variety of reasons (see Fearing [1987] for a discussion of the baton twirling task). 
Ensuring that the failure rate goes down would involve a great deal of modeling - both in 
terms of the geometry of the grasped object and in terms of the physics of the grasping 
operations. 

In this section we present a method for solving the trajectory planning problem during 
manipulation tasks. This method relies on a number of restrictive assumptions. Some of 
these will be relaxed in later sections and we will see that planning trajectories in carte- 
sian space for robot hands has quite a different flavor from conventional robot trajectory 
planning. 

In conventional robotics, trajectory planning is usually considered a problem of speci- 
fying the positions, velocities and accelerations of the end-effector to carry out a particular 
task. One way of finding such a specification given the initial and final positions of the end- 
effector is by using constraint-satisfaction techniques. A variety of constraint polynomials 
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have been used, including cubics to ensure continuity of positions and velocities at the end- 
points of the motion, quintics to ensure position, velocity and acceleration constraints (see 
for example Mujtaba [1977]). Resolved motion rate control proposed by Whitney [1969] 
has been used to repeatedly compute the velocity commands to an underlying velocity 
controller from the equation: 

9 = J" 1 * (4.18) 

This method assumes that the cartesian velocity of the end-effector is known or can be com- 
puted from the task specification. A method based on computing the successive positions 
and orientations of the end-effector using homogenous transforms has also been proposed 
by Paul [1981]. A recursive way of computing the joint space trajectories associated with 
straight-line cartesian space trajectories has been proposed by Taylor [1979]. This bounded- 
deviation method relies on computing the error in cartesian space of a given trajectory using 
forward kinematics. 

Computing the trajectories to be followed by fingertips of a robot hand manipulating a 
grasped object is slightly more complicated. As can be seen easily, if one computes straight- 
line trajectories from the initial positions of the finger tips to their final positions, one could 
end up crushing a grasped object. A grasped object basically imposes kinematic constraints 
on where the finger tips or the contacting surfaces can be. Throughout the motion of such a 
grasped object these constraints have to be satisfied so that the relative distances between 
the grasp surfaces does not change. A three-fingered hand like the Salisbury hand can be 
said to make three point contacts with any object it grasps. These three points define a 
triangle in space which must not change shape as the object is moved by the hand. In the 
case of the Utah- MIT hand one can think of the tetrahedron formed by the contact points 
as being manipulated in space instead of the grasped object. 

The goal, therefore, is to compute a time history of cartesian positions xik which denotes 
the cartesian position of the i'th finger tip at the fc'th time step. Once we have these 
cartesian positions, using the inverse kinematics relations, we can compute the stream of 
required joint angles. 

In the following sections we outline two ways of solving the trajectory planning prob- 
lem during a grasping operation. The two ways differ in their representation of rotations 
and consequently in how many operations they need to compute the intermediate points. 
The first method uses homogenous transformations to represent rotations while the second 
method uses quaternions. 

The first scheme of computing the joint space trajectories follows the presentation out- 
lined in Chiu [1983], wherein linear joint interpolation is used to achieve cartesian space 
trajectories of the finger tips. The scheme relies on computing intermediate knot points of 
a given trajectory and then uses linear joint interpolation between the knot points. 

4.5.3 Motions Specified using Homogenous Transforms 

The motion of a grasped object can be specified in a number of ways. We first deal 
with motions specified using homogenous transformation matrices. 
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4.5.3.1 Motion Specified Relative to an Absolute Reference 

Generally speaking, it will be possible to indicate this motion relative to an absolute 
reference frame by a homogenous transform matrix A° m . In order to satisfy the constraints 
that at each point in the motion the contact points must not move relative to one another, 
we have to compute the position of the grasped object at every instant of the motion. 
Following the notation in Paul [1981], we can see that this can be done by the following 
equation. Note that the equation indicates a screwing motion that translates and rotates 
the grasped object at the same time, in contrast to method outlined by Paul wherein the 
rotation is split into two separate rotations. 



KM = 



Rot(n,9(t)) p(t) 
1 



(4.19) 



The above equation essentially expresses the famous theorem by Chasles, that any 
motion can be considered to be a combination of a translation p with a unique rotation of 
angle about a unique rotation axis n. If a linear interpolation is used, and if this motion 
needs to be performed in N steps, then after k steps the body will have translated to a 
position given by 

k p 

and will have rotated by k 0/N about the rotation axis n. However, the orientation of the 
object will be indicated by 

R(t k ) = R k (h,^) 

since rotations are composed by multiplying the rotation matrices together. 

Now consider an object grasped by the finger-tips at n contact points. The cartesian 
co-ordinates of the finger-tips can be represented by xj. At any given instant during the 
specified motion therefore 

*i(0 = A° m (t) xi(to) 
where Xi(i ) specifies the position of the finger tips at the beginning of the motion. 

4.5.3.2 Motion Specified Relative to an Alternate Frame 

In some cases it may be necessary to specify the motion not in a global reference frame 
but relative to some other frame, say A r . The contact points xj(<o) can be expressed 
relative to this initial frame by A' 1 xj(tfo). If the motion expressed relative to the A r frame 
is A T m (t), then the finger tip positions at any given instant during the motion can be seen 
to be 

A r A r m (t) A^ 1 Xi (<o) 

relative to the global reference frame. 

As outlined in the previous section, motions can be specified relative to an absolute 
reference frame. Such motions are meaningful only in a few situations. More often one 
desires to specify these motions relative to the grasped object; For example, the operation 



§4.5 Higher Level Control 53 

of a screw driver involves twisting about an axis defined by the screw driver, while exerting 
a force about that axis. The problem therefore becomes one of determining a meaning- 
ful frame relative to which the motion ought to be specified. In other words, what is a 
meaningful value for the frame A r in the last equation? 

Location of this object specific reference frame A r can be referred to as the grasp 
localization problem, since it refers to identifying the position and orientation of a grasped 
object within a dexterous hand. This can be solved in three different ways. 

1. The first method is to use external sensing modalities like vision or tactile sensing, 
to identify the frame A r directly from identifying visually or tactually observable 
features on the grasped object. 

2. The second method is to assume that the grasp points are known relative to this 
frame (usually this is the form that the output of a planner will generally take). This 
implies solving for the elements of A r from: 

Xj(* ) = A r Xj r 

The left hand side of the above equation can be gotten from the forward kinematics 
at instant *o. xj 7 " specifies the grasp points relative to this frame A r . The first 
method which relies on sensors could be affected by sensor noise but is unaffected 
by uncertainties in the initial positions and orientations of the grasped object. The 
second method on the other hand requires a detailed knowledge of where the fingers 
are placed relative to this frame and could compute the wrong value for A r if the 
fingers are not where they are supposed to be. 

3. A third method outlined in Chiu [1983] is to compute a frame known as the grasp 
frame relative to the positions of the finger tips A g = f^x^to)). Then the frame 
A r can be specified relative to this grasp frame by A r = A g At. This method 
computes forward from the current finger tip positions and is a compromise between 
the previous two. It will be affected both by sensor noise and by uncertainties in the 
initial position and orientation of the grasped object. 

To summarize therefore, we present the iterative algorithm for actually computing the 
intermediate knot-points during a cartesian trajectory. 
Input: 

1. A motion spec of the form [n,0,p] specifying a rotation of about an axis n, and a 
translation p along the axis. 

2. N The number of intermediate knot points to compute. 

3. The frame A r relative to which this motion spec has to be applied. 
Output: 

1. A stream of cartesian positions Xjk for all the finger tips. For the Utah-MIT hand i 
ranges from to 3, and k ranges from to N - 1. 
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Computation: 

1. Compute A' 1 , X|(< ), and x sta rt = A' 1 x.i(t ). 

2. Compute A0 = 0/N and Ap = p/N. 

3. Let A r represent the incremental translation and rotation represented by [n, A0, Ap]. 



A r = 



Rot(h,A0) Ap 
1 



4. Let A = A r . For i from to N by 1 do compute: 

x i+l — -^t+1 x start 

4.5.4 Motions Specified using Quaternions 

In the previous section, we used homogenous transforms to represent motions. We 
presented algorithms for two cases. First, the motion was specified relative to an absolute 
frame, and then, an alternate frame of reference was used to specify the motion. The 
algorithms outlined above essentially rely on computing the position and orientation of a 
grasped object at different points during a motion, and then computing the trajectories 
traced by the finger tips relative to this frame. The computational complexity of doing this 
in real time can be seen to be essentially 

C(2i oT 2 ) + n C(T o v) 

where C(T\ o T 2 ) represents the complexity of composing one transformation matrix with 
another, and C(T o v) represents the complexity of computing a vector transformed by a 
motion transformation. 

If one represents the configuration of an object using homogenous transformations, it 
would take a total of 33M+24A to compose two transforms. (The rotations alone would take 
24M+15A - since the rotation matrix part of a homogenous transform is orthonormal the 
third column can be computed as the cross product of the previous two). The operation 
of computing the transformation of a single point v by a transformation matrix T can be 
expressed as 

v' = Rot(T) o v + Trans(T) 

Computing the first term in the above equation can be done in 9M+6A operations, while the 
second term takes 3 more additions. Therefore a total of 9M+9A operations are required 
to do the second operation. 

The total number of operations needed to perform the online trajectory computation 
neglecting the precomputations performed is given by (33+9n)M + (24+9n)A. For n = 4 as 
is the case with the Utah- MIT hand this turns out to be 60M+51A. 
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In this section, we will essentially use the same algorithm as in the previous section, 
but use a different representation for rotations. Unit quaternions provide a compact rep- 
resentation of rotations. In fact, such quaternions have been used by Taylor [1979] in his 
trajectory planning scheme for conventional robots. Such a quaternion represents a rota- 
tion of 9 about an axis n as [cos(^), nsm(|)]. We will denote a quaternion as the a scalar 
part <7o taken together with a vector part q to form the quaternion Q = [<7o,qo]- 

The configuration of the object can be described by C Q = [x Q , Qo]- The position of the 
object is represented by the position vector x Q while the orientation is represented by the 
unit quaternion Q Q . A short description of the quaternion representation for rotations and 
its use can be found in Horn [1986]. 

In the standard representation quaternion composition of rotations takes only 16M+9A. 
Computing the transformation of point vectors by a quaternion takes 22M+12A in the stan- 
dard representation of this composition which is: 

v' = v( 9 2 - q • q) + 2(v • q)q + 2 q q X y 

As suggested in Canny [1984], we can express the above equation as 

v =v + 2qx(qxv) + 2gqxv 

which can be computed using only 15M+12A operations. 3 . 

The total complexity of doing the online trajectory computation using such a repre- 
sentation of rotation is given therefore by (16+15n)M + (9+12n)A operations. For the 
Utah-MIT hand this figure turns out to be 76M+57A. The complexity of operating with 
quaternions can be seen to be slightly higher. 

The above two ways of computing the trajectories assumed that the object was translat- 
ing uniformly and rotating at a uniform angular velocity as it made the required rotation. 
If one relaxes this requirement that the angular velocity be uniform, an alternate represen- 
tation for rotations that uses the scaling property of quaternions can be used to denote Qo 
by Qo = [ljfiian^)]. Using this a linear representation for intermediate points during a 
rotation can be derived as 

Q(t) = [l,*n*an(^)] 

where t could range continuously from to 1. 

This allows the intermediate orientations of an object be computed essentially with 
three multiplications and renormalizations. Such a trajectory through orientation space 
will not have a uniform angular velocity as noted by Canny [1984], although it will ac- 
complish the required rotation about the required axis. The desirable feature about this 
representation is that since it relies on a continuous representation it allows a planner to be 
able to compute the intermediate orientation of the grasped object at any point during the 
trajectory. Needless to say, there are other ways of defining Q(t), but a linear interpolation 
as defined by the equation suggested above, is perhaps the simplest. 

3 Multiplication by 1 or 2 is counted trivially as an addition operation - see Salamin [1979] 
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Chapter 5 

Force Control 



Pure position control requires accurate manipulators. This is especially true in assembly 
tasks that require fine manipulation capabilities. Typical part dimensions in optical fiber 
assemblies or magnetic core assemblies for computers are less than a millimeter while the 
tolerance on the parts is of the order of 0.25 micrometers. More recent integrated circuit 
manufacturing tasks require positioning stages that are accurate to 0.02 micrometers (see 
Toumi et al. [1986]). 

It is clear that to achieve such accuracies, much higher standards need to be achieved 
in the manufacturing and control of robots. 

In some tasks, however, merely increasing the accuracy of the robot performing the task 
is not enough. If such tasks are to be performed by robots under conventional position con- 
trol, the models that the robot uses need to be near perfect. The model of the environment 
needs to be accurate so that the motion planner can generate the right positions that the 
robot must move to. The model of the robot in terms of kinematic and dynamic param- 
eters needs to be accurate too, so that a controller can generate the right signals to the 
actuators while making the motions that the planners generate in the presence of unknown 
disturbances. In reality, perfect robot models, and even good robot models, are hard to 
come by. The changing and unstructured environment is again impossible to model and 
hence pure accurate position control for robot manipulators faces fundamental limitations 
for certain kinds of tasks. 

In this section, we present the force control algorithm presented originally in Hollerbach, 
Narasimhan and Wood [1985] that forms the basis for the implementation of the force 
controller for the Utah-MIT hand. 

5.1 Introduction and Previous Work 

A force controller can be implemented in a number of different ways. In general, using 
a force sensor to monitor the forces of interaction that a manipulator experiences, and then 
using this force information to modify the controlled parameters like position or velocity 
of the robot has been termed force control (see Whitney [1985]). It has also been applied 
to the process of generating force signals, in response to deviations from some nominal 
trajectory (see Salisbury [1982]). 

It is instructive to consider the different alternatives that have been proposed in the 
literature (Whitney [1985] presents a survey of current force control methods and Maples 
and Becker [1986] provide a further classification). We will deal exclusively with active force 
control schemes, as opposed to passive force control schemes wherein the inherent mechan- 
ical compliance of a manipulator is used to perform tasks that require fine manipulation. 
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It must be mentioned that no real manipulator is perfectly stiff, and every robot has some 
amount of inherent mechanical compliance. This is especially true in the case of a robot like 
the Utah-MIT hand wherein the inherent damping and mechanical compliance provided by 
the underlying mechanical system comes very close to providing an ideally stable system 
for tasks that involve contact with the environment. 

Damping control was proposed by Whitney [1977]. In this form of force control, the 
inverse of a damping matrix is used to modify the desired velocity vector based on the 
sensed forces. Such a form of control has also been assumed by planners which use the 
so-called generalized damper formulation (see Lozano-Perez et al. [1984], Donald [1987], 
Erdmann [1984]). 

Salisbury et al. [1982] proposed an alternative to damping control, which has now come 
to be known as stiffness control. In this method, the underlying controller is one that 
generates forces in response to deviations from some nominal trajectory according to a 
generalized-spring model. His driving equations then could be expressed as 

f = K Ps -Ax 

(5.1) 
r = J T K Px JA0 

The quantity J K Px J can be denoted as K Pe and represents the cartesian stiffness matrix 
mapped to joint space. 

Hogan [1985] provides yet another alternative called impedance control which uses damp- 
ing and stiffness matrices to control a so-called virtual manipulator. Raibert and Craig 
[1981] propose a scheme called the hybrid force control scheme wherein certain axes of the 
manipulator are force controlled while others are controlled using conventional position 
control schemes. Mason [1982] presents a formal theory of how natural and artificial con- 
straints arising out of a given task situation can be used to provide information to a hybrid 
controller. 

Perhaps the most important choice that has to be made in designing a force control 
scheme is to decide the co-ordinate system in which the error to the controller will be 
measured. In the scheme proposed by Salisbury et al. [1982] the cartesian error Ax can 
be mapped to joint space using the cartesian stiffness matrix mapped to joint space. The 
errors in this method are computed in joint space (A0). In the hybrid position and force 
control scheme (Raibert and Craig [1981]), and in the generalized damper scheme (Whitney 
[1977]) the errors are computed in cartesian space. 

There are many problems associated with computing the error in joint space. First, 
it is more natural to describe tasks in cartesian space and describe the partitioning of 
which joints are to be force controlled and which are to be position controlled in this task 
space (see Mason [1982]). Specifying these task level constraints in joint space is certainly 
cumbersome. If the task level constraints are specified in cartesian space but the underlying 
controller is written to operate in joint space, then usually some scheme for interpolating 
has to be designed. These interpolation schemes in joint space usually result in curved axes 
in cartesian space (see Chiu [1983] for an interpolating controller based on the generalized 
stiffness method). 
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The advantage to joint based schemes that is often cited in the literature is that the 
computation associated with such schemes is often small when compared with cartesian 
based schemes. But as we will see later on in this chapter, this is not necessarily true. 
In practice, as reported in Maples and Becker [1986] specialized fine tuning of joint based 
controllers often adds to system complexity. 

These considerations led to our choice for computing the error in cartesian space instead 
of joint space. 

A number of papers on force control published recently have dealt with the stability 
issues associated with such controllers, since most force controllers have had problems 
with stability when the robot comes into contact with a stiff environment. An [1986] 
identifies the kinematic and dynamic instabilities that can occur when a robot contacts its 
environment, and presents the results of a number of experiments performed with a high 
performance direct drive robot. The importance of modelling and estimation coupled with 
experimentation to test the validity of theoretical results is emphasized in this significant 
work. To solve the stability problem, Whitney [1985] and Roberts [1984] have proposed 
using a compliant covering to increasing the damping at the end-effector. An [1986] has 
proposed adapting to the stiffness of the environment by using an identified model of the 
dynamics of the environment. Using joint torque sensing in lieu of a tip force sensor in the 
feedback loop has been proposed by Wu and Paul [1980] and studied in detail by An [1986]. 

5.2 The Force Control Algorithm 

Before going into the details of the force control algorithm, it is useful to briefly outline 
what needs to be computed and why. 

Consider an object being grasped by the finger tips. (Note that we are making the 
assumption that no non-tip contact is made, which in some cases could be overly restrictive). 
To manipulate the object (i.e. to move it) or to exert forces on the environment with it, one 
could say that one has to exert a wrench on the object. These wrenches can be exerted on 
the object only through the contacting surfaces. If the wrench to be exerted on the object 
is specified, then the problem can be seen to comprise of two subproblems, viz., 

1. computing the wrenches to be exerted at the contacting surfaces and then 

2. computing the joint torques so that these wrenches will be exerted at these contacting 
surfaces. 

5.2.1 Lines, Screws, Wrenches, and Twists 

The following section presents briefly some necessary mathematical groundwork, so that 
the algorithm presented later on in this chapter can be easily understood. 

A line in space can be represented by four quantities, for example, the slope and in- 
tercept of the projections of the line onto two different orthogonal planes. A line can also 
be represented by its so-called Pliicker co-ordinates, wherein a line is represented by six 
numbers L = [l,m,n,p,q,r] . The numbers l,m,n are the direction cosines of the line 
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and p, q, r represent the moment of the line about the origin of some reference co-ordinate 
system. This can also be denoted as [l,r X 1]. From this it follows that 

Ip + mq + nr = ' 

A screw is a five dimensional quantity, which is basically a line in space augmented with 
a quantity called the pitch. If the screw is represented by S = [So, Si, S 2 , S3, S4,S 5 ] T , the 
pitch is given by: 

_ S0S3 + S1S4 + S2S5 
Ps ~ S 2 + 52 + Si 

If a screw is given by S = [S„, S ] the Pliicker line co-ordinates of S are given by 

Owing to a famous theorem by Poinsot, any system of forces and torques acting on a 
body can be reduced to a single force and torque, in effect, a wrench. This means that the 
effect of all the contact wrenches will be the same as if a single body wrench were applied 
to the body as a whole. An analogous theorem due to Chasles states that a displacement 
of a rigid body can be considered to be a unique rotation about an axis combined with a 
unique translation about that axis. 

A twist (or wrench) is a six dimensional quantity used to represent generalized motion 
(or forces). The primary difference between the two is that wrenches add just like vectors 
while twists do not (only innnitesimally small twists do). The six dimensional quantities 
are basically a screw augmented with an amplitude. In the case of five-dimensional screws 

5 2 + 5? + 5| = 1 

but in the case of a twist (wrench), the sum of the square of the primary component forms 
the amplitude. 

Twists and wrenches provide a convenient representation for thinking about contacts 
and grasping with articulated hands. 

5.2.2 Internal Forces 

Consider an object being held by the fingers of a dexterous hand. Each contacting sur- 
face exerts a particular wrench on the object, by restricting its motion in certain directions. 
This set of wrenches exerted by the contact points can be termed the contact wrenches. 

Let the generalized force exerted by the grasped object on the environment be denoted 

by 

w = (f , n ) 

and the sum of the contact wrenches be denoted by 

w e = (f e ,n e ) 



15.2 The Force Control Algorithm 61 

Such an object force can be synthesized from the task requirements using artificial and 
natural constraints, but for now we will assume that it is specified in some fashion (see for 
example Mason [1982]). 

Each contact point i exerts a wrench w,- through the point of contact. This wrench 
is made up of a number of components parallel to the basis wrenches, the composition of 
which depends on the type of contact model assumed. For example, a point contact with 
friction in three dimensions prevents relative translation between the contacting surface 
and the grasped object, but does not prevent relative rotation. Relative translation will be 
opposed by a frictional force. This frictional force will have one component normal to the 
surface of contact, and two parallel to a plane tangential to the contacting surface. The 
force normal to the surface is unisense, but the other two components can be bidirectional. 
If a soft finger contacting model is assumed, then there can be a fourth component in 
the wrench exerted by the contacting surface, namely, a torque arising about the contact 
normal. 

Salisbury [1982] classifies the different types of contact possible based on the wrench 
systems they exert on the grasped object in three dimensions. Let w e be the external 
wrench exerted on the grasped object as the result of all the tip contacts. 

n ni 

We = Y, J2 A «i w «'i ( 5 - 3 ) 

where n is the number of contacts and n,- refers to the number of wrenches belonging to 
the set of wrenches caused by contact surface i. More compactly, 

w e = Wc 

where W = (w n ,.. . ,wi ni ,w 2ni ,. . .,w nn „) and c = (An,.. . , A lni , A 2 i,.. .,A nn J. 

It can be seen that this system of equations is underconstrained. In the case of three 
fingers assuming a model of point contact with friction, W is a 6 X 9 matrix, while under 
a soft finger contact model, it is a 9 X 12 matrix. 

In the above equation A,j refers to the intensity or magnitude of the j'th component of 
the i'th contact wrench. Clearly, since some of the contact wrench components need to be 
unisense, these wrench intensities have to be positive in any solution. 

In its most general form, the solution to the above equation can be expressed as: 

C = C p + C h (5.4) 

where C p is the particular solution, and Ch is the homogenous solution that lies in the 
null space of W. Salisbury [1982] and Kerr [1984] have both suggested the use of the right 
generalized inverse to solve for C p . The components of C^ are the internal grasp forces. 
Such a combination of wrench intensities lying in the nullspace of W that will result in no 
net wrench on the object can be chosen a number of different ways. 

Salisbury [1985] augmented this equation with additional internal grip force equations 
to make the system of equations solvable, as follows: 

fij = (fi-fj)-r tj (5.5) 
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where f, is the force exerted by finger *, r tj is the unit vector from the xth to the jth contact 
point, and /„•_,- is a specified scalar internal grasping force. 

In general, there is a question as to how these internal forces are defined and how they 
are specified. Kerr and Roth [1986] present an algorithm to choose these internal forces so 
that an optimally stable grasp can be achieved. This algorithm relies on simplifying the 
friction constraints to four linear constraints (the friction cone is considered to be bounded 
by some friction pyramid), and then solving the resulting linear programming problem 
using standard techniques. 

Notice that from the above equation we have one internal force component per pair of 
contacts. This means that for three degree of freedom fingers there will be 3 C 2 or three such 
internal force components. If we assume a point contact with friction model, each contact 
exerts a force on the object but no torque at the contacting point. The specification of all the 
finger tip forces would involve specifying the nine components of these three force vectors. 
Augmenting the wrench to be exerted on the object (which involves six components) with 
the internal forces, we see that the resulting system of equations becomes solvable. 

The same result holds for point contact with friction models, for four contact points as 
well as can be seen from Table 5.1. 



no. of contacts 



tipforce components 



12 



15 



w„ 



internal forces 



10 



Table 5.1: Summary of external equations required - point contact with friction. 

We can see from the table that for point contacts with friction, the above definition of 
internal forces gives rise to an overdetermined system in the case of two finger contacts, and 
an overdetermined system for five fingered contacts. It has been pointed out by Salisbury 
[1982] that to achieve complete restraint with any of the three degree of freedom contact 
types is not possible. For example, two point contacts with friction grasping an object will 
still not be able to restrict twists about an axis between the two point contacts. 

In the case of three soft-fingered contacts there are twelve components to be solved for. 
By using the above definition of internal forces we can get three additional constraints. The 
remaining three constraints can be defined to be the linear forces along lines formed by the 
intersection of the planes normal to the contacting surfaces. 



u 


= 


A 4 (n 1 


xn 2 ) 


f 5 


= 


As(ni 


xn 3 ) 


h 


= 


^6(n2 


xn 3 ) 



(5.6) 



where rq represents the surface normal vector at the i'th contact point, A,- represents the 
force component and f- the i'th additional force. These three equations when added to 
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the others make the system of equations solvable in the three fingered contact case, with 
soft finger contacts. Notice that using such a definition implies knowledge of the contact 
surface geometry. In the algorithm presented below, we solve the three and four fingered 
case assuming a point contact model with friction but do not solve the soft-finger contact 
model. 

5.3 Algorithm 

In general therefore, the computation of the control law can be broken into the following 
steps. 

1. Sense joint positions and contact points at finger surfaces. 

2. Compute present cartesian position of the grasped object. 

3. Compute the cartesian position error Ax of the object from its desired position. 

4. Compute the control wrench w to be exerted on the object. This is done by some 
control law (usually the Generalized Stiffness equation is used), using the position 
error computed in the previous step. 

5. Compute from this wrench the wrenches that need to be exerted at the finger tips, 
or other contacting surfaces. 

6. From the finger tip force compute the joint torques that need to be exerted by the 
actuators. 

There are a number of assumptions implicit in the above mentioned algorithm. It is 
instructive to enumerate them, so as to get an idea of the algorithm's general applicability. 
It should also be mentioned that while certain steps of the algorithm are inherently serial, 
others are not. Such portions of the algorithm can be implemented very conveniently in 
parallel on the computational architecture that we have developed. 

1. We have assumed that the contact points stick. No sliding or relative motion is 
assumed to occur between the contact points and the grasped object. 

2. Usually some kind of contact model has to be assumed, which remains fixed for 
a specified duration. A soft-finger type of contact is very different from a planar 
contact with friction, and the solvability of some of the equations will depend on the 
type of contact model chosen. Also, a planar contact may change to a line contact 
when the object moves around within the hand. 

3. The entire operation is assumed to be quasi-static. If fingers move fast enough, then 
the dynamics of the contact situation need to be considered and will complicate the 
analysis to a very great extent. 
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4. We have also implicitly assumed that accurate joint torque control is possible. This 
assumption is usually implicit in most force control schemes. Almost all of these 
formulations whose output involves forces or torques assume that the underlying 
controller and actuation systems will be able to achieve the forces or torques asked 
of them. This may not be necessarily true. 

5. Objects are assumed to be rigid as are fingertips. In reality most finger tips have soft 
coverings on them to prevent them from damage and to increase grip stability, and 
objects can be made of non-rigid materials too. 



5.4 Computing the Object Displacement 

The first two steps of the algorithm essentially involve the computation of the forward 
kinematics which we have already covered. As a result of this computation, we get the 
cartesian positions of the contact points (which are usually at the fingertips). 

Given the cartesian positions of the finger tips, the next step is to compute the differen- 
tial displacement of the grasped object. This differential displacement can be computed in 
one of two ways. The first is conceptually easy to understand but suffers from the inability 
to recognize a number of special cases; the second yields a simple and compact solution. 

It is easily shown that one can compute the displacement of a body, given the displace- 
ment of three non-collinear points on the body. We can express the position vector of a 
contact point as 

r, = r + lj 

From this the displacement of each of the fingertips can be written as: 

dr,- = dr + uj X 1; 

where dr represents the translation of the grasped object, u represents the rotation of the 
grasped object and 1, represents a vector drawn from the representative point to a contact 
point. Subtracting one equation from the other and expressing them in matrix form we 
get: 



(5.7) 



for three contact points. The above equation can be easily solved for the components of u 
by using the fact that 

-u> z U>y 



drx — dr2 




I1-I2 


dri — dr3 


= u; X 


I1-I3 


dr 2 - dr 3 




I2-I3 



WX 



u> z 











To solve the vector equation, one can solve for u> and then recover the components of 
dr using one of the above equations. There are many special cases involved in the above 
computation which takes 17M+38A steps. These have to do with cases wherein a division by 
zero would occur. Taking care of such cases would require further computation. Whether 
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the motion is really a translation or a rotation is also not readily apparent in the above 
formulation. 

Using the theorems mentioned above, one can formulate another algorithm that recovers 
the components of a screw displacement, given the displacements of the finger tips. The 
algorithm is a slightly modified version of the algorithm given in Angeles [1982]. Let a, b 
and c denote three displacement vectors dri,dr2 and dr3. The objective is to compute n, 
the vector about which the rotation occurs, the translation along this vector and the angle 
of rotation. The algorithm proceeds as follows: 

1. Compute differences between pairs of displacement vectors. Let 

6 a = a - b 

6 b = b-c (5.8) 

6 C = a — c 

2. Check for collinearity. Compute (a — c) X (b — c), and check if this vector is equal to 
the null vector. If the points are collinear, then choose another point and try again. 

3. If all of them are identical to zero, then the motion is a pure translation which is 
equal to any of the displacement vectors. 

4. If two of these differences are identical to zero and if these are 6 a and 6b, then define 
a new motion arising out of subtracting 6 C from the other two vectors. This will 
mean that there will now be two non-vanishing difference vectors and one can use the 
following case. 

5. If one of them is identical to zero 1 , then check if the two remaining are parallel by 
checking if the cross product 6b X 6 C is the null vector. If the two difference vectors 
are non-parallel, then n can be computed as their cross product. If they are parallel, 
then one of them can be expressed as a constant multiple of the other. 

6 b = P6 C 
The vector n can then be computed as the normalized form of the vector given below: 

b - c - /3(a - c) 

6. If none of the differences are identical to zero, then we compute 6 C ■ (6 a X 6b) to see 
if they are co-planar. If they are not coplanar then the vector n can be computed as 
the cross produce of two of the displacement vectors as before. If they are co-planar, 
then we compute if the differences are parallel, by computing (6 a — 6 C ) x (6b — 6 C ). If 
they are parallel, then the motion is once again a pure translation. If they are not 
parallel, then n can be computed as the cross product of these two difference vectors 
as before. 



1 Without loss of generality, we can assume that 6 a is the vector that vanishes. 
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7. Compute the angle of rotation and the linear displacement if they haven't still been 
computed. This is done using 

ac-a'c 

cos{9) = ~VW ( 5 - 9 ) 

8 = S a -h 

where a is the initial position of one of the points, a is its final position after the 
move has been made and c is a point on the screw axis. 

The complexity of the above algorithm is higher than the previous one mentioned in 
the worst case. As can be seen, depending on the nature of the motion involved, the 
computations can range between 6M+19A to 31M+28A. The average case complexity will of 
course be much better in this algorithm, and we prefer it since it recognizes all the special 
cases involved. 

The next step in the algorithm calculates the force to be exerted on the object based 
on its displacement. The usual form of a generalized stiffness formulation is used. The 
stiffness matrix K p is specified in cartesian space as mentioned before. The force on the 
object is calculated using: 



w„ 



K p . Ax + K„- Ax + wj (5.10) 



where K p represents the stiffness matrix, K. v represents the damping matrix and wj is a 
bias wrench. Usually, both the 6x6 matrices K p and K„ are diagonal. Such matrices can 
be specified by a programmer or synthesized from the nature of a task. This computation, 
assuming diagonal matrices, takes 12M+12A operations. 

5.5 Computing the Fingertip Forces 

The next step is perhaps the most complicated one in the algorithm. Given the wrench 
to be exerted on the object, our objective is to compute the wrenches that need to be 
exerted by the fingertips in order that the desired object wrench be realized. There are 
many ways of performing this computation, the most efficient of which is to use a method 
that relies on representing the forces as vectors and uses the definition of internal forces as 
given by Salisbury [1982]. 

5.5.1 Three Point Contact with Friction 

The single observation that helps in speeding up this part of the computation consid- 
erably is that one can take advantage of the inherent geometry involved in the situation. 
This can be done by solving not for the components of the tip forces themselves but for the 
projections of these forces along the interfinger position vectors, along which the internal 
forces have been defined to act (see Figure 5.1). 

The internal gripping forces are specified as: 
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Figure 5.1: Three point contact with friction. 



(fi - f 2 ) • 1*12 = /12 

(fi - f 3 ) • ri3 = / 13 

(f 2 - f 3 ) • (ri2 - ri 3 ) = / 23 



(5.11) 



where these quantities have been defined previously. The force and torque balance equations 



are: 



fe = fl+f 2 + f 3 



n R 



= ri2 X f 2 + P 13 X f 3 



(5.12) 



The torque n e exerted on the object is expressed about the contact point made at the 
first finger. This can be derived from the torque n specified with respect to some other 
reference point on the object by: 



n e = n + r x f e 



(5.13) 



where r is the vector connecting the first finger contact point to the reference point 0. 

The force balance equation can be projected along the non-orthogonal co-ordinate sys- 
tem formed by the vectors r i2 , r 13 , and r i2 X r 13 . This gives: 
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Ie • 1*12 = 

fe • r 13 = 
f e • (ri2 x r 13 ) = 

Similarly for the torques, 



fi • Ti2 + f2 • ri2 + f3 • Tl2 
f 1 • m + f2 • J*i3 + ^3 • Tl3 
fi • (ri2 X ri 3 ) + f2 • (ri2 x r 13 ) + f 3 • (ri 2 X r X3 ) 



(5.14) 



n e -ri2 = (ri2 xf 2 )-r 12 + (ri 3 xf 3 )-r 12 
n e -r 13 = (r 12 xf 2 )Ti3 + (n 3 xf 3 )-r 13 
n e • (n 2 x r 13 ) = (r 12 x f 2 ) • (r 12 x r 13 ) + (ri 3 x f 3 ) • (n 2 x n 3 ) 

which is more conveniently rewritten as 



(5.15) 



n e • ri2 = f 3 • (r 12 x r a3 ) 
n e • ri 3 = -f 2 • (ri 2 x r X3 ) 
n e • (r i2 x r i3 ) = (f 2 • ri 3 )(r? 2 ) - h • ri 2 (ri 2 • ri 3 ) + f 3 • ri 3 (ri 2 • r i3 ) 
-f 3 • ri 2 (rf 3 ) 



(5.16) 



With the above equations the solutions for the fingertip forces can be found first in the 
non-orthogonal co-ordinate system given by the vectors ri2, rj 3 , and ri2 x ri 3 as follows: 



fa . _ (ri2 X n 3 ) • n e + r? 2 (/ 23 - f e • ri 3 ) + rf 3 (f e • r 12 - fa) - K& r{ z - r 12 • ri 3 ) 

2 (r 12 • r X3 - r\ 2 - r? 3 ) 

(5.17) 
where K, = ^{fa — fa - fa + f e • ri2 + f e • ri 3 ). Using the above, and solving for the 
projection of f 2 along ri 2 and ri 3 : 



f 2 • ri 2 = K — f 3 • ri 3 

f2 • ri 3 = f e • ri 3 - / 23 - 2 f 3 • ri 3 

f 3 • r i2 = f e • r X2 - fa - 2 f 2 • r i2 



(5.18) 



^2 • ri 3 



fe • Tl3 - /23 - 2 f 3 • ri 3 



One can now finally solve for the projections of fi along the two vectors ri2 and ri 3 : 



f l • 1*12 = fa + f 2 • ri 2 
f l • ri3 = / 23 + f 3 • ri 3 



(5.19) 



From the above equations it is apparent that computing the components of the fin- 
gertip forces along ri 2 , ri 3 , and ri 2 X ri 3 can be done extremely efficiently. Once these 
components have been computed it may be necessary to orthogonalize them. To convert 
these components into orthogonal force components, Gaussian elimination of the following 
matrix equation can be used: 



r 12 
r 13 



f, = b, 



(5.20) 



(ri2 X r x3 ) J 
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Computation 


Multiplies 


Additions 


Coefficients needed to compute f3 • 1-13 


30 


25 


Recovering the other components 


12 


10 


Orthogonalization 


36 


30 


Conversion of n to n e 


6 


6 


Grand Total 


84 


71 


Direct Gaussian-Elimination 


295 


183 



Table 5.2: Summary of computational requirements: Three point contact. 



where the constants b, are the actual finger force components in the non-orthogonal co- 
ordinate system just computed. 

A summary of the computational complexity of the method is presented in Table 5.2. 
Performing the transformation to the non-orthogonal co-ordinate system in the three point 
contact case can be seen to reduce the computational burden by almost a factor of four. 2 



5.5.2 Four Point Contact with Friction 

The four point contact case with friction is an interesting case, since it corresponds 
more closely to the case of the Utah-MIT hand. In this case one has to compute three 
orthogonal force components for four fingertip contact forces. The specified external force 
has six components and therefore an additional six internal grasping force components need 
to be specified. 

Using the same definition of internal force as before, we can see that it is always unam- 
biguously possible to get six components taking the inter-finger forces pairwise, providing 
that all the four grasp points are non-coplanar. 

The force and torque balance equations for four-point contact are: 



n e = r 12 x f 2 + r 13 x f 3 + r i4 x f 4 



(5.21) 



The vectors ri 2 , ri3, and ri 4 form a non-orthogonal co-ordinate system. These three vectors 
provide a natural system in which to solve for the force components (see Figure 5.2). The 
internal force constraints written in terms of these vectors are: 



2 It can be shown that to perform simple Gaussian Elimination on an n x n matrix it takes n { n + 1 )( 2n + 1 ) 
multiplies, n divides and %n 3 + |n 2 - |?i additions as in Hovannessian et al.[1969]. In our analysis, divisions 
have been assumed to take the same amount of time as multiplies. 
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Figure 5.2: Four point contact with friction. 





(fi - f 2 ) • ri2 


= 


/12 




(f i - f 3 ) • r 13 


= 


A3 




(fi - f 4 ) • ri4 


= 


/l4 


(f 2 


- ^3) • (ri2 - ri 3 ) 


= 


/23 


(U 


- h) ■ (ri4 - ri 2 ) 


= 


/42 


(U 


- f3) • (ri4 - r X3 ) 


= 


/43 



(5.22) 



Since fi does not appear in the torque balance equation because the torques were 
referenced to the first finger contact point, we begin the process of eliminating variables by 
removing fi from the first three equations in (5.22) through substitution from (5.21). Also, 
expanding the last three equations in (5.22) yields: 

/12 + 2 f 2 • ri2 + f 3 • r 12 + f 4 

/13 + f 2 • ri3 + 2 f 3 • ri3 + f 4 

/14 + f 2 -ri4 + f 3 -ri4 + 2f 4 T14 = i e -ri4 ^c; , . 

f 2 -r X2 -f 2 -ri3-f 3 -n 2 + f 3 ---- - f - < A ^ V- ) 

?4 • ri4 - f4 • ri 2 — f 2 • r-14 + f 2 
f 4 • n 4 - f 4 • ri3 - f 3 • ri4 + f 3 



ri 2 


= 


U • ri 2 


(a) 


ri3 


= 


f e • ri 3 


(b) 


ri4 


= 


fe • 1*14 


(c) 


ri3 


= 


/23 


(d) 


ri 2 


= 


/42 


(e) 


ri3 


= 


/43 


(f) 
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Adding the above set of equations and rearranging: 



f 2 • ri2 + f3 • ri3 + f 4 • r 14 = - (/ 23 + / 42 + / 43 - /12 - /13 - fi4 + f e • (1*12 + ri 3 + r 14 )) 

(5.24) 
To reduce the vector equation for the torque-balance into its scalar components, it is 
projected along the vectors ri 2 x r 13 , n 2 x ri 4 , and n 3 x ri 4 . This yields the following 
three equations after the appropriate expansions have been performed: 



O12 X n 3 ) • n e = (f 2 • ri 3 ) (r? 2 ) - (f 2 • r 12 ) (r l2 • r x3 ) + (f 3 • n 3 ) (ri 2 • n 3 ) 
-(fs • ria) (r 13 ) + (f 4 • r 13 ) (r 12 • r 14 ) - (f 4 • r 12 ) (n 3 • r X4 ) 

(r X2 X n 4 ) • n e = (f 2 • r 14 ) (rf 2 ) - (f 2 • r 12 ) (ri 2 • r 14 ) + (f 3 • r 14 ) (r 12 • r 13 ) 
-(fs • 1*12) (r 13 • ri 4 ) + (f 4 • n 4 ) (ri 2 • r 14 ) - (f 4 • r x2 ) (rf 4 ) 

(ri 3 X r 14 ) • n e = (f 2 • r 14 ) (r 12 • ri 3 ) - (f 2 • r 13 ) (r 12 • r 14 ) + (f 3 • r 14 ) (r? 3 ) 
-(fa • ri 3 ) (r 13 • ri 4 ) + (f 4 • r 14 ) (ri 3 • r 14 ) - (f 4 • r 13 ) (r? 4 ) 



(5.25) 



Since fi has been eliminated, nine variables remain. The solution proceeds by reducing 
(5.25) to four variables, f 2 • ri 2 , f 3 • ri 3 , f 4 • r X4 and f 2 • ri 3 . With (5.24) the original system 
of equations is reduced to a 4 X 4 matrix equation solvable by Gaussian elimination. The 
remaining components are then recovered, and finally the components of the fingertip forces 
along the inter-finger vectors are orthogonalized as before. 

By simple manipulations on (5.23), the remaining five variables are expressed in terms 
of these four variables: 



*4 • ri 3 = -f2 • r X3 - 2 f 3 • ri 3 - / 13 + f e • ri 3 

f 4 • 1*12 = -3 f 2 • r X2 + f 2 • 1:13 - f 3 • r X3 + / 23 - /12 + f e • ri2 

f 3 -ri 4 = f 2 -r 13 + 3f 3 -r 13 + f 4 T 14 + / 13 -/ 43 -f e .r 13 (5.26) 

^3 • r 12 = f 2 • ri 2 - f 2 • ri 3 + f 3 • ri 3 - / 23 

f 2 • ri 4 = -f 2 • r X3 - 3 f 3 • ri 3 - 3 f 4 • r i4 + f 13 - / 14 + / 43 + f e • (r i3 + r i4 ) 

Substituting into (5.25), 

( r i2 + r i 3 - r i2 • ri 4 - r X3 • ri 4 )(f 2 • r i3 ) + (3ri 3 • r l4 - r\ 3 - r 12 • r i3 )(f 2 • ri 2 ) + (r 12 • r 13 

~ r i3 - 2r i2 • ri4 + ri 3 • r 14 )(f 3 • r i3 ) = n e • (r 12 x r 13 ) + (r X3 • r X4 )(f e • r x2 + / 23 - /12) 

+(ri3 • r 14 )(/i 3 - f e • n 3 ) - / 23 (rf 3 ) 

(5.27) 
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Computation 


Multiplies 


Additions 


Coefficients of the 4x4 matrix 


65 


91 


Gaussian Elimination of the matrix 


40 


32 


Recovering other components 


4 


28 


Orthogonalization 


48 


40 


Conversion of n to n e 


6 


6 


Grand Total 


163 


197 


Direct Gaussian-Elimination 


662 


446 



Table 5.3: Summary of computational requirements: Four point contact. 



(r-12 • r-13 + r x3 • r X4 - r\ 2 - r? 4 )(f 2 • ri 3 ) + (3r? 4 - r 12 • r 14 - r 13 • ri 4 )(f 2 • ri 2 ) 

+( r i4 - 3rf 2 + 3ri 2 • n 3 - ri 3 • ri 4 )(f 3 • r i3 ) + (r X2 • ri 3 + r a2 • n 4 - 3r? 2 )(f 4 • ri 4 ) 

= n e • (r 12 x n 4 ) + (f e • ri 3 )(n 2 • r 13 - t\ 2 ) + r? 2 (/i 4 - / 43 + f 13 - U • ri 4 ) - / 2 3(r i3 • r 14 ) 

+r? 4 (/ 23 - /12 + f e • r a2 ) 

(5.28) 

( r i4 + r i3 - r i2 • ru - r X2 • ri 3 )(f 2 • ri 3 ) + (3rf 3 + 2 rf 4 - 3r i2 • n 3 - r a3 • ri 4 )(f 3 • n 3 ) 

+( r i3 + r i3 • ru - 3r i2 • r x3 )(f 4 • r i4 ) = n e • (ri 3 x n 4 ) + (f e • ri 3 )(rf 3 + r? 4 - r 12 • n 3 ) 

-(ri 2 • ri 3 )(f e • r X4 - / 14 + / 43 - / 13 ) - r? 3 (/ 23 - / 43 ) - f 13 (r? 4 ) 

(5.29) 

Equations (5.27)-(5.29) and (5.24) form a 4 x 4 matrix equation, that can be solved by 
Gaussian elimination. Once this has been done, the remaining components can be recovered 
using (5.26). This procedure will result in finally solving for the fingertip forces along the 
three vectors formed by r>i 2 , ri 3 , and ri 4 . These components can be orthogonalized in a 
manner similar to that outlined for the three point contact case. 

The computational requirements for the four point contact case are summarized in 
Table 5.3. Similar to the three point case, a factor of four improvement in efficiency over 
Gaussian elimination is obtained. 



5.6 Computing the Joint Torques 

As we saw on the section on position control, the lower level controller is designed to 
take as input either joint positions or joint torques. In this chapter, we have shown how one 
can compute the forces to be exerted at the fingertips based on a desired force to be exerted 
on a grasped object, and a desired stiffness matrix. The actual torques to be exerted at 
the joints can be computed from these values using the relation r,- = J^fj. 
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In the case of the Utah-MIT hand, however, one can use an important kinematic feature 
of each finger to reduce the computations needed for this part of the algorithm. The last 
three joints of each finger of this hand form a 3R planar pair; also, the first axis of rotation 
is perpendicular to the axes of the planar pair. 

For point contact with friction, only the force component f e of the contact wrench w e 
acts on the finger joints. To take advantage of the 3R planar pair formed by the last three 
joints, f e is first rotated by 6\ using the following A matrix 3 : 



A, = 



This yields: 



l f - 



d Si 
5i -Ci 
1 



/exW — /ej/'-'l 
fez 



(5.30) 



(5.31) 



The contact point made at the fingertip is located by the vector I4, as measured from 
the co-ordinate system affixed to the last finger joint. This quantity can be sensed using a 
tactile sensor (Siegel [1986]) and expressed with respect to a co-ordinate system affixed to 
the first joint of the finger using the following equation: 



M 4 = 



UxC234 — UyS 234 
234 

42 



UxS234 — UvC; 



4 U 



(5.32) 



Expressing w e about the most distal joint p: 



l p — l e 
S = 1 l 4 X 1 f e 



(5.33) 



It is now fairly straightforward to solve for the joint torques. Denoting r t to be the 
torque to be exerted at joint i, and a, as the various link lengths, one gets: 



_ 1 



n. 



pz 



(5.34) 



Tz = X n pz + a 3 ( 1 f P yC 2 3 - 1 f P xS23) 

T 2 = T 3 + a 2 ( 1 fpyC2- 1 f px S2) 

n = 1 n py - 1 f pz (ai + a 2 C 2 + CI3C23) 

These equations can be evaluated quickly with only 23 multiplications and 14 additions. 
Other methods that rely on the transpose of the Jacobian matrix are computationally not 
as efficient. 

The total for the entire algorithm is therefore summarized in Table 5.4. 



Notation: a) C xyz stands for cos(Q x + 6 y + d z ). b) The left superscript before any quantity indicates 
the frame of reference in which that quantity has been expressed, c) Joint numberings are 1 to 4 instead of 
to 3 as indicated in the kinematics calculations. 
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Computation 


Multiplies 


Additions 


Forward Kinematics 


94 


63 


Computing object displacement 


40 


34 


Control Equation 


12 


12 


Fingertip force computation 


167 


210 


Joint torque computation 


23 


14 


Total 


336 


333 



Table 5.4: Summary of computations for the force control algorithm. 



5.7 Implementation 

The implementation of this force control algorithms has been completed on the ar- 
chitecture to be described in the next chapter. We have just begun performing various 
experiments with this implementation and hope to continue these experiments in the near 
future. Force controllers present in the literature often stop at the point when the torques 
have been computed. It is assumed to be the job of the underlying real time controller to 
ensure that these torques are accurately achieved. 

In reality, this may be true of robots driven by electric motors where the current applied 
to the motors is a very good approximation of the torques applied by the motors at the 
robot's joints. Even with such robots, Paul [1987] indicates that simply closing a torque 
loop may not be the best one can do. In the case of robots like the Utah-MIT hand the 
voltages applied to the actuators affect the tendon tensions in a very complicated fashion. 
The hysteresis present in the magnetic field that causes the deflection of the primary jet in 
the pneumatic valves causes stiction which is very hard to model. The coulombic friction 
present in the transmission as the tendons pass over the pulleys is another source of problems 
although it is not quite so severe. 

Another practical issue that has to be dealt with, since the system is dual-acting, is the 
effect of the controller on one of the tendons (on the flexor say), which shows up as a load 
on the other (on the extensor). Modelling the effect of the tendon dynamics present in such 
a system would enable much higher performance to be attained. 



5.8 Future Work 

A lot of work remains to be done with respect to the force controller implementation. 
It is imperative that a good understanding of the underlying actuator and transmission 
system be attained first. Without such a model, it would be very hard to ensure the accu- 
rate exertion of torques, which is what the algorithm presented in this chapter ultimately 
relies on. As indicated by our initial grasping experiments, it is clear that the kinematic 
structure of the hand interacts with a grasped object in a number of interesting ways. An 
understanding of how the passive compliance in such mechanisms as the Utah-MIT hand 
could be used to sense contact, grasp objects more stably and manipulate them still seems 



mm 



|M ffetttM IKv* 






If 



Bin * 1m^[ itmnd t»4£fcMV%$Nftt«i§ 




:-^ " 



SraSftf.*.-'.; 




- ^3t 





■ *l 


•>- 


- "; 


5 


t-.s:-'- . ' 


' m 


^^T&— : ^'- '*' 


f t 


* 


Rf 


-=*li^ 


i 




^Fi0 : ^:i 


i 


Mv. 






r •'■.!.'• -■ . 




* ; &:A&t*M 


SSTKr.;. 



."JS 



■'is* 






"jfe 



*Sif 



:^.*-V , :--OT 




S4;-f^V ; --iSli? 


"jp;, ■ 


.- "•>. 


^Jilitflfe^ '"■■''■ 


ftl.SfPl 


: ^ ; ^: 


'*:';'>■.': ■-■■■■Sfi 


.-" jk. - 






■^■ r -v*v#S 


£i|i^'^I% ; -4* 







'W^ 



■i 






isfi 






*is?^ s$< 



Chapter 6 
Computational Architecture 



Experimentation and validation of theoretical results is important in any applied science. 
Consequently, research publications in robotics often contain sections devoted to implemen- 
tation. The value of such experiments cannot be overemphasized. 

For performing such research coupled with experimentation, powerful tools are neces- 
sary. Robots like the Utah-MIT hand that push the state of the art in terms of mechanisms, 
actuators and transmission systems allow investigations into new levels of performance that 
previous generation robots could not hope to achieve. These robots are characterized by a 
number of joints and consequently demand powerful computer architectures to be controlled 
and utilized effectively. 

An unusually large portion of time spent on the work presented in the previous chapters 
was actually spent on the implementation and testing of the control algorithms on real 
hardware. In this chapter we describe the computational architecture on which the control 
algorithms outlined in the previous chapters have been implemented. This chapter is fairly 
self-contained, and is intended for researchers who spend their time implementing control 
strategies on robot hardware. As such, it contains a somewhat eclectic collection of ideas 
and can be omitted by the reader not interested in such detail. 

As we saw earlier, controlling a complex device like the Utah-MIT dexterous hand in 
real-time is an extremely compute intensive task. One of the first problems we addressed 
therefore, (and one that took the longest to find a good solution to) was the development 
of a suitable computational architecture which would be adequate for the task. As a tool 
for doing useful research in robotics, we feel that the computational architecture described 
in the following sections will be adequate for some time to come. 

The term "computational architecture" is used to denote both the hardware architecture 
and the software systems that have been developed as a solution to the real time control 
problem in a research environment. The first version of the solution was implemented on 
Motorola 68000 single board computers running on the Multibus-I. The second and present 
version is based on Motorola 68020 boards running on the VME-Bus. The entire real time 
development system has come to be known as the CONDOR programming environment. 

We feel that the amount of time spent on implementing the software and hardware 
systems has been worthwhile. One of the glaring deficiencies in the state of current research 
in robotics control is the diversity of the primitive control architectures that are used. The 
diversity makes it harder for researchers to share implementations, to build on previous 
work and to some extent even hampers the reproducibility of experimental results. The 
primitive nature of the hardware on the other hand, restricts the complexity of the devices 
that can be controlled by such systems. 

We must mention that our effort in developing the computational architecture has been 
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more successful than we had anticipated. The system has been used to control other robotic 
devices beside the Utah-MIT dexterous hand, notably the MIT Serial Link Direct Drive 
Arm, and more recently the Whole Arm Manipulation System. A number of similar systems 
are in the process of being built inside MIT's Artificial Intelligence Laboratory to control 
various real-time devices and other research institutions that have the Utah-MIT hand. 

6.1 Design Motivation 

Controlling the hand, or any other high-performance real-time robotic device, is essen- 
tially a compute bound task. If one uses a single processor to control all the joints and 
process all the sensory information, one would need an extremely fast (and consequently, a 
very expensive) cpu to perform the lowest levels of control. 

Two desirable goals for any real-time controller to be used as an experimental tool 
are flexibility and efficiency. The first of these ensures that adequate mechanisms will 
be provided by the system to perform the necessary experiments, while the second ensures 
that the needed performance in terms of computational horsepower to control these complex 
experimental devices will also be provided. Computational architectures found in industry 
often provide performance at the expense of flexibility, while university efforts have resulted 
in architectures that sometimes do not provide adequate real-time response. 

To illustrate this problem, consider the fact that the Utah-MIT hand has four fingers 
each with four- degrees of freedom. If the sixteen joints need to be servo 'ed at a rate of 
one thousand hertz, then using a one MIP 1 processor like a VAX 11/780 would leave only 
63 instructions per joint per servo in which all the computations have to be performed. 
The cost of a uniprocessor whose performance is adequate could be as high as one million 
dollars. Clearly, less expensive solutions are desirable. 

The first observation that makes this problem easier is that 

• At the level of actuators and joints, robot control exhibits coarse-grain parallelism. 

By the above statement we mean that the parallelism inherent in most robotics control 
algorithms (see Hollerbach [1980], Raibert and Craig [1981] for typical examples) is not at 
the level of individual instructions or arithmetic statements but at the level of functions and 
processes (see Lathrop [1983] for a systolic architecture approach to exploit the parallelism 
in manipulator dynamics). 

What this observation transfers down to at the architecture level is that having multi- 
tudes of processors, each of which can execute only a small repertoire of instructions, will 
probably not help very much for implementing robot control algorithms. By coarse-grain 
parallelism I also mean that the amount of processing power required at each node could 
be substantial. In fact, Version I of the CONDOR had no provisions for floating point 
arithmetic since it was felt at the time that scaled integers would suffice for most of our 
computations. Soon, however, the complexity of implementing digital control loops with 
such scaled arithmetic forced us to realize that we would benefit substantially with the 



'One MIP is one million instructions per second - a measure over which there has been considerable 
controversy in the recent past with the advent of RISC machines. 
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addition of floating point hardware. Version II of the CONDOR therefore has the fast 
Motorola 68681 floating point unit in addition to the Motorola 68020 processor. 
The second observation of controllers for real time systems is that 

• Real time control involves i/o with external peripherals, and the word "real" in real- 
time translates to servicing hardware interrupts with low latency. 

This constraint is often a very severe one, especially when the robot to be controlled 
is even moderately complex. The need for low-overhead and efficient schemes for imple- 
menting control programs often is in direct conflict with the goals of flexibility and ease 
of program development. Servicing interrupts on a single processor is not a significant 
problem, and if the scheduler has been designed correctly, very complex servoing can be 
done. However, on a multiple processor system, this raises rather complex issues. First, the 
system needs to be modeled as a multi-rate system if a hierarchical controller with various 
routines running at different rates on different processors is implemented. Secondly, the 
issue of synchronization becomes harder to address than in a SIMD environment. How- 
ever, such issues are far outweighed by the advantages of having a multiple microprocessor 
system, which are: 

(a) The implementation of hierarchical controllers is possible in a flexible and modular 
way. 

(b) More processing power can be added if needed, by adding more processors to the 

system. 

The hardware design that we finally chose has fairly sophisticated processors in the form 
of single-board computers plugged into a standard bus. The Version-I design was based 
on computers based on the Motorola 68000, while the Version-II design was based on the 
Motorola 68020 cpu, coupled with the Motorola 68881 floating point unit. The interconnect 
scheme chosen for the different processors was the Multibus for Version-I hardware and 
VME-Bus for the next version. 

In Table 6.1 we give a performance comparison of the different cpu's we looked at, and 
in Table 6.1 we give a summary of the different interconnect schemes we considered. 

Another major design decision we made was to use off-the-shelf hardware. A number of 
man years have been wasted in robotics laboratories, building custom solutions to hardware 
problems, which we wanted desperately to avoid. Developing high performance hardware is 
a task best left to companies that specialize at it. Integration at the board level might have 
been appropriate had board level products not been available to satisfy our requirements, 
but as it turned out, powerful single board computers were available at low costs. Hence we 
chose to concentrate our efforts at the system integration level, using board level products. 

The use of an industry standard interconnect scheme cannot be overemphasized. The 
benefits of using a standard interconnect bus are that 

(a) One can get other peripherals (like A/D and D/A converters) for such interconnects 
relatively easily. 
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Processor Type 


Speed 


Cost 


Comments 


Microvax II 


1 MIP 


mod 


interconnect problems 


Vax 11/750 


0.6 MIP 


high 


interconnect problems 


Vax 11/780 


1 MIP 


high 


interconnect problems 


Symbolics 3600 


1 MIPS 


high 


lacks real time support 


National 32032 


1MIPS 


low 




Motorola 68000 


1 MIPS 


low 


lacks floating point 


Motorola 68020 


2.5 MIPS 


low 


has a ftp co-processor 



Table 6.1: Comparisons of processing power available from alternative hardware configura- 
tions. 



Interconnect Type 


Speed 


Bandwidth 


Comments 


Serial Lines 


300-38Kbaud 


low 


Too slow 


Parallel Ports 


100K-200Kbaud 


low 


Slow 


Ethernet 


10 Megabits/s 


fairly high 


Complicated software 
but fast 


DMA-DR11-W 


1 Megabyte/s 


fairly high 


Complicated software 
but fast 


Bus-to-Bus Adaptor 


Bus Speeds 


high 


Simple software and 
fast 



Table 6.2: Comparisons of different types of interconnect. 



(b) The migration path to newer hardware as faster boards become available is relatively 
painless. 

(c) Replication and trouble shooting are much easier with published specifications. 

(d) An objective comparison of such interconnect schemes can be made. 

The block diagram of the resulting hardware is shown in Figure 6.1 for the Version-I 
hardware, while Figure 6.2 shows the final hardware configuration. 

The selection of the right pieces of hardware certainly took more time than anticipated. 
This was mainly caused by the fact that although we had chosen the industry standard 
VME bus as our interconnect, the concept of linking such busses together using a bus-to- 
bus adaptor had not been put to test fully at the time we put our system together. The use 
of a 16 MHz 68020, with 1 megabytes of no wait-state, dual port ram also was state of the 
art at the time. This meant that we had our bit of hardware trouble shooting to do, even 
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Figure 6.1: Block Diagram of Version I of the hardware. 



though the individual components we were working with were all supposed to conform to 
a standard. 

A more detailed discussion of the design decisions pertaining to the Version I hardware 
can be found in Siegel et al. [1985]. This paper also details some of the software issues 
involved. 

It must be pointed out that other research efforts have also recognized the cost ben- 
efits in using such a microprocessor architecture for their control laboratories. Of these, 
the NYMPH system described in Chen et al. [1986] and the system being built at IBM 
described by Korein et al. [1986] are patterned after our CONDOR system. Besides these 
systems, there have been other efforts that have tried to couple a real time microprocessor 
architecture along with a development host. Our system differs from these controllers in 
two important ways. Firstly, we attempt to avoid duplicating software and hardware com- 
ponents that can be found on conventional, non real-time systems. Essentially, our system 
is partitioned into a real-time processing component and a conventional time-sharing com- 
puter development component. Secondly, we provide an extremely efficient computation 
environment. Only the minimal set of features necessary to provide a reasonable and con- 
venient environment were included. This insures highly efficient operation of the CONDOR 
controller. 
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Figure 6.2: Block Diagram of Version II of the hardware. 



For example, Kim et al. [1987] describe a Multibus based real time system for controlling 
the Puma/RAL hand system. Their system is based on single board computers connected 
with a Multibus. Their development processor is one of the single board computers, and 
it provides access to disk and other system resources. We chose not to use this approach 
for several reasons. Most importantly, we feel that conventional computer systems offer 
adequate file serving and user interface capabilities, and did not want to duplicate such 
facilities in our real-time system. Secondly, bus bandwidth on the real-time system is best 
left for real-time uses, and adding the development host's traffic on the same bus only 
exacerbates the contention for this resource. 



Paul et al. [1986] describe another system built to control a Puma robot. This system 
is similar to our Version I architecture in that it uses the Multibus-I for its intercon- 
nect scheme. Connection to the development host was made initially through an ethernet 
communication link, but the complicated software needed to drive such an interface has 
necessitated the addition of boards that provide DMA access, much like in our Version I 
hardware. 
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6.1.1 Comparison between Version I and Version II 

As is obvious from the figures, perhaps the main difference between the two different 
versions of the hardware has been the inclusion of the bus-to-bus adaptor which makes 
possible a shared-memory implementation of a message passing scheme, which has been 
the key to a fast and extensible control hierarchy. 

There are a number of desirable features present in the new hardware that were com- 
pletely absent in the earlier version. The bus-to-bus adaptor enables transparent access 
from the development host into the dual-ported shared memory on the control micropro- 
cessors. In the Version I hardware, the DMA connection was being made between widely 
disparate hardware. Consequently, the software had to contend with different data formats, 
and this resulted in wasteful format conversions that had to be performed on every data 
transfer. The connection was slow, at times unreliable and of low bandwidth. 

The individual microprocessors on the Version II hardware are fast processors, and 
coupled with the floating point engine they come equipped with, provide a much faster 
environment for scientific and control computing. The Version I software performed most 
of its computation using scaled integer arithmetic. Although such code is highly efficient, 
it is also unreadable and unmaintainable in some instances. Floating point on the other 
hand may be significantly slower if implemented in software. 

The Sun-3 development host also provides a much better environment in terms of bit- 
mapped graphics, an industry standard window system and a transparent compiler (in 
Version I a cross compiler had to be used) that generates compact code. Programs that 
run on the controller processors can typically be run on the Sun-3 development host without 
recompilation. 

To summarize, the features common to both versions of our hardware design have been: 

1. Low cost, but powerful, multiple, single board computers performing the real time 
control function. 

2. A development host that runs 4.2 BSD Unix to perform the software development on. 

3. A relatively high bandwidth interconnect between the two systems. 

4. An industry standard bus that connects up the slave microprocessors. 

5. Dual-ported ram on the control processors, that facilitates control programs to take 
advantage of the shared-memory architecture. 

6. A Mailbox interrupt that provides a hardware mechanism for interprocessor commu- 
nication. 

The differences have been: 

1. The Version II hardware uses the same processor for the development host and the 
control processor, obviating the need for a cross compiler. 

2. The Version II interconnect is the VME-Bus which is faster, provides support for full 
32 bit transfers and is now the industry standard. The Multibus-I which was the 
interconnect used in the Version I hardware is now outdated. 
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3. The single board computer used in the new hardware runs at 16 megahertz, and 
contains a floating point co-processor. 

4. The development host in the new system, a Sun-3, provides bit-mapped graphics, a 
fully networked file system and a much better software environment. 

5. The connection between the development host and the control processors is made via 
a bus-to-bus adaptor in the Version II hardware which provides a more transparent 
form of access and communication. 

6.2 Software 

An important piece in any computational architecture is the software that is available 
to run on the hardware. Our comments regarding flexibility and efficiency of robot control 
hardware apply equally as well to the software components. 

The software system designed to control the hand and other such robotic devices is 
relatively large and is adequately described elsewhere in a programmer's manual. In this 
section we will merely provide an overview of what we feel are the innovative aspects of the 
software system. 

The design goals of the software system were to: 

(a) provide a flexible environment in which control programs can be written, debugged 
and run, 

(b) provide efficient, low overhead means of doing often required tasks, 

(c) provide easy to use programmer libraries for dealing with data transfer hardware, and 
real-time interaction with robotic devices and 

(d) provide a sophisticated user interface with support for bit-mapped graphics. 

To achieve these goals, the CONDOR system is structured around a few relatively simple 
organizing principles. In a typical program development scenario, the user is expected to 
write and compile his program on a development machine. This development host is a Sun- 
3 workstation in our system. Since the Sun runs the Unix operating system 2 , this means 
that the programmer has at his disposal all the software tools that he needs for writing and 
compiling his program. Once the program has been compiled, it is downloaded onto the 
slave microprocessors, where it is actually run. In this environment, which is also called the 
run-time environment, the user has access to a number of program libraries at his disposal, 
which enable him to do a number of tasks in a flexible and portable fashion. 

Thus, the CONDOR environment is really two different environments. First, there 
is the environment on the Sun workstations known as the development environment, and 
then there is the run-time or real-time environment on the slave microprocessors. Much 
effort was put into making the Sun and the slave microprocessor run-time environments as 



2 Most of the system runs on Sun O.S. 3.2 which is closely compatible with and is based on Berkeley 4.2 
BSD Unix. 
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compatible as possible. In fact, most programs that run on the real-time controllers will 
run on the Sun simply by relinking them with the appropriate library. 

In the following sections, we provide a brief overview of some of the important subsys- 
tems of the CONDOR programming environment. The discussion is restricted to pieces 
of software that actually took substantial time to implement and that contain innovative 
contributions in terms of software engineering and system development. 

We must mention that the hardware architecture is a tightly-coupled, truly MIMD ma- 
chine. As such, it requires that a programmer write programs that run on the different 
processors. Our approach to managing this multiplicity problem in terms of software en- 
gineering has been largely to ignore it. We felt that the coarse-grain parallelism existing 
in current control programs and algorithms could be managed by the programmer himself. 
Therefore, we chose not to impose any restrictions on what a programmer could do. Fur- 
thermore any automatic scheduling or load-balancing scheme necessitates some overhead, 
impairing the performance of the system as a whole. The effort involved in implementing 
such a scheme is often not commensurate with its benefits. 

Typically, control programs partition fairly cleanly, and hence manually deciding upon 
a partitioning scheme has not proved to be a problem in practice. 

The number of processors in our control development scenario rarely exceeds five or six 
and we do not expect this architecture to be applied to problems requiring more than a 
dozen processors. Under this number, managing the different programs that need to run 
on the different processors can be done with existing software tools like make 3 . 

6.2.1 Devices 

Interacting with robots usually means involvement with different types of hardware 
devices. Most robots have idiosyncratic controllers as their front ends, and a diverse array 
of sensor devices. A number of schemes exist for actually performing data transfers; polling, 
vectored and non- vectored interrupts, direct memory access are but few of many. 

Any computational architecture that expects to deal with these robots must have mech- 
anisms to support these different ways of interacting with devices. 

The design of the device system was motivated partly by our experience with an earlier 
version of the system. In Version I of the CONDOR there was no systematic way of 
dealing with devices. In fact, what existed was an ad-hoc interface between the read and 
write system calls and various device specific routines. Even this interface was not strictly 
adhered to by most of our device drivers. This meant that to use a parallel port board 
that had been plugged into the system a user had to be aware of the procedures needed to 
initialize it, and be aware of what addresses the device's registers occupied and a myriad of 
other low level details. In Version II of the CONDOR we distinctly felt a need for a clean 
design at the lowest level. 

The CONDOR real-time environment was therefore designed to provide an extensible 
way of writing device drivers which are program modules that control real-time devices that 
the CONDOR environment is aware of. Only the writer of a device driver need be aware 



make is a Unix program for managing complex programs comprising a number of different modules. 
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of low level details like hardware addresses and interrupt mechanisms. The CONDOR 
system also provides a standard and well-documented manner in which device drivers can 
be written and automates much of the bookkeeping previously done by the device drivers 
themselves. 

The CONDOR system's device mechanisms have been designed to be extremely fast 
and portable. The mechanism is static. All that is required to install a new hardware 
device is to recompile the system libraries used by the programmers. This is in contrast 
to other complicated systems that provide support for downloadable device drivers at run 
time rather than compile time. The overhead associated with recompilation is significantly 
lower than the overhead and complexity associated with any dynamic loading scheme. 

The functions that these mechanisms provide are as follows: 

1. Provide for automatic device initialization. 

2. Provide capabilities to handle interrupting devices. 

3. Provide capabilities to handle shared interrupt vectors. 

4. Provide standard system calls like open, read and write, where appropriate. 

5. Provide extensibility to handle devices that may require more than the standard set 
of routines. 

The mechanisms for handling devices is modeled after the style found in early versions 
of Unix although there are a few significant differences. Each device is essentially modeled 
as an abstract data type, on which a few standard operations can be performed. When 
such a device is opened, an integer object called a file descriptor is returned whose 
semantics are close to that of the conventional Unix file descriptor. Users can then use this 
object as an argument to other operations that they need performed on the device. 

The standard file descriptor usually maps to a device structure that has the following 
fields: 



ict devsw { 




char *dvname; 




int Odvopen) () 


; /* open routine */ 


int (*dvclose)(); /* close */ 


int (*dvread) () 


; /* read */ 


int (*dvwrite) () ; /* write */ 


int OdvcntlK) 


; /* ioctl */ 


int (*dvinit)() 


; /* init - probe */ 


int (*dvputc)() 


; /* put a char */ 


int (*dvgetc)() 


/* get a char */ 


int (*dvseek)() 


/* seek */ 


int (*dviint)() 


/* input interrupt routine */ 


int (*dvoint) () , 


/* output interrupt routine */ 


char *dvdata; 


/* device specific data */ 
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char *dvbuf ; /* device's buffer */ 

int dvno; /* device's no */ 

int *dvcsrs; /* device csr array */ 

int *dvvectors; /* device's vector array */ 

int dvnumvectors ; /* number vectors for a single device*/ 

>; 

The configuration for the entire system is initialized statically at compile time. For 
example, a parallel port board may be described by an entry similar to the one given below 
in the configuration file: 

/* 4 Motorola Parallel Port Board */ 

■C 

"mpp", mpp.open, mpp_close, mpp_read, mpp_write, 

mpp_cntl, mpp_xinit, NULL, NULL, ionull, 

mpp_xint, mpp_xint, NULL, NULL, 0, mpp_csr, mpp_vec, 2, 

}, 

The following piece of code shows how a programmer can for example open a parallel 
port device and set it up for further operations: 

int 

parallel_port_startup(board_number) 
int board.number; 

{ 

int fd; 

if((fd = open(" :mpp" , board.number, 2)) < 0){ 

printfO 'Couldn't open device?\r\n' ') ; 

exit(0); 
} 

/* Reset the board */ 
mpp_reset(fd) ; 

/* Configure the board to be in raw 16-bit mode */ 
mpp_conf ig_16bit_raw(f d) ; 



/* return the fd, so that the user can use it later */ 
return (fd) ; 



} 



As the above usage illustrates, each device has an open() routine, a closeO routine 
etc. There is one system-specific configuration file that tells the run-time system, what 
types of devices are supposed to exist and other required parameters. The CONDOR run- 
time system will, upon startup on the slave microprocessors, try to find all such devices 
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and initialize them as specified by the device's init() routine. This is analogous to the 
probe () routine in conventional Unix systems. 

When the user-level program then begins running on the slave microprocessors, they can 
perform operations like open, read, or write on these devices. The system maps these 
device independent calls, through the file descriptor objects to device specific routines. 
Although the file descriptors are allocated each time a device is open'ed, they will 
map to the same device level buffers, since the CONDOR is not multi-tasking. The lower 
level interrupt routines, which we will mention briefly later, operate on these device-specific 
buffers. 

Thus it becomes extremely easy to add devices onto an existing CONDOR system. The 
writer of the device driver merely has to write his individual routines that correspond to 
entries in the device configuration file, and recompile the system. 

There are a number of different operations that can usually be performed on devices 
besides the usual read, write set. The common Unix way of handling such unusual oper- 
ations is to overload the common system call known as ioctl(). But this approach can 
soon get out of hand, with a large number of ioctl options being defined, each with its own 
peculiarity. In the CONDOR system we chose to use the following conventions to deal with 
this problem, and in practice, this has proved effective. 

1. Device specific routines will be uniquely named by prefixing the routine with the 
name of the device (for example, a routine for configuring the mpp device will be 
called mpp_conf igure). 

2. Routines that are peculiar to a device will take the file descriptor as the first argument 
and map it to a device specific structure. Once this mapping has been performed, 
that driver can then do any kind of operation that it desires. This essentially provides 
entry points into the device driver through a back door - not through the standard 
device structure that contains device specific versions of read, write etc. 

The device driver interface also provides the low-level glue for the interrupt mechanisms, 
the file server interface and the buffered stdio libraries. 

6.2.2 Interrupts 

Besides the ability to deal with devices, another capability that control system archi- 
tectures require is the ability to service interrupts in real-time. These interrupts usually 
correspond to events that require attention, or periodic interrupts from the timer at some 
sampling rate. 

The VME-bus provides support for eight levels of prioritized vectored interrupts, and 
the Motorola 68020 processor has the capability to support 256 different interrupt vectors. 
Interrupts on the VME-Bus are vectored, in contrast to the Multibus-I which supports 
non- vectored interrupts. The Multibus-II supports a different notion of interrupts which 
essentially increases the number of different levels of interrupt possible on the bus. 

Interrupts can come from a variety of sources: interval timers, a-d and d-a converters, 
parallel and serial i/o devices, etc. It is important that all such interrupts be handled in 
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a uniform and extensible fashion. In Version I of the CONDOR, interrupts were handled 
in a rather ad-hoc fashion. This resulted in a lot of assembler code sprinkled throughout 
the system, since most interrupt servicing routines have a small assembler portion that 
dispatches to a routine written in a higher level language. 

In Version II of the CONDOR, all interrupts vector to the same higher level routine. 
The system has a software data structure that maps vector numbers to interrupt servicing 
routines. This scheme has resulted in a single assembler routine that services all interrupts. 

There are a few complications that must be dealt with. When an interrupt is generated 
and needs to be serviced by a processor, somehow enough information must be found that 
allows this interrupt to be mapped to a file descriptor corresponding to a device. Since the 
CONDOR is not multi-tasking, no distinction exists between system space and user space. 
When a serial chip interrupts the system telling it that it has a character to transmit, the 
system has to be able to tell which serial-i/o driver's input buffer the character must be 
sent to. 

The problem is further complicated by the fact interrupt vectors can be shared. This 
means that two devices can both interrupt the system using the same level and same 
interrupt vector. The CONDOR system solves such complications by maintaining a list of 
all devices that express interest in receiving interrupts on a particular vector. When more 
than one device can vector using the same interrupt vector, the CONDOR system maps this 
interrupt vector to a generalized device-level interrupt vector. This routine goes through 
the list of interested devices and invokes the interrupt routine of each of those devices one 
by one. 

Each interrupt routine when invoked by the system is passed two arguments telling it 
the vector number and a pointer to a saved copy of the registers that reflect the state of 
the machine when the interrupt occurred. The device level interrupt on the other hand 
invokes its interrupt routines with arguments indicating the file descriptor corresponding 
to the interrupt, and the minor device number (since more than one device may use the 
same interrupt vector number), in addition to these two. 

6.2.3 Message Passing 

The message passing sub system is another low level system of the CONDOR. While the 
device driver and support routines are intended mainly to provide support for bootstrapping 
and running a program on a single processor, the message passing system tries to address 
the issue of multiple processors and the need for communication between them. 

6.2.3.1 Introduction 

The message passing system provides a simple, low-overhead manner in which com- 
munication of data can occur between processors that comprise the CONDOR controller. 
A typical application running on the CONDOR controller comprises of a set of processes 
running on the microprocessors. These processes can communicate with one another using 
the message passing system. Since the servos are always compute bound tasks, any system 
for communication between such tasks has to be extremely time-efficient in order not to 
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impair the real time performance of the system noticeably. The primary design goal of the 
message passing system was therefore efficiency. 

The present system is to a large extent, a redesign of the system described in Narasimhan 
et al. [1986]. Although the functionality provided by that system was far greater than that 
provided by the present version, I feel that this second attempt has been made substantially 
more efficient. 

6.2.3.2 Messages 

In any multiprocessing environment interprocessor communication is a necessity. Since 
the Ironies processors and the Sun host computer are all bus masters on a common VME 
bus, each machine has access to each other's dual ported memory. Interprocessor commu- 
nication occurs over the bus and directly uses shared memory. This allows, for example, 
any processor to directly access data in another processor's memory. The most basic form 
of interprocessor communication possible would be direct memory reads and writes from 
another processor storage. Unfortunately, this unrestricted access, though highly efficient, 
is hard to control. 

To overcome the problems of unrestricted memory access, a mailbox-based message 
passing system is supported. Mailbox interrupts can be thought of as a software extension to 
the processor's hardware level interrupts. Another way of thinking about them conceptually 
is to regard mailbox numbers as port numbers that map to specific remote procedure calls. 

A mailbox interrupt has a vector number and a handler routine. When a particular 
mailbox vector arrives, its appropriate handler is invoked. The handler is passed the pro- 
cessor number that initiated the mailbox interrupt and a one integer data value. This 
integer data value is the message data 4 . To summarize, there are two pieces of data that 
get transmitted for every message - a message handler number and a piece of integer data 
that can be used as the user sees fit. 

The Version I message passing system was substantially more complex. Messages could 
be of arbitrary size, and they could be addressed not to individual processors but to so- 
called virtual devices that corresponded to Version IPs remote procedures. These remote 
procedures were assigned to processors by a preprocessor that took as input an assignment 
file, that mentioned which routines were to be available on which processor. The prepro- 
cessor then generated a routing table that had to be linked in with each program running 
on the individual processors so that the send routine on that processor could decide based 
on the recipient virtual device number alone which processor it ought to send the message 
to. 

Another important capability that the Version I implementation lacked was the ability 
to reply to messages. This meant that application programmers had no way of knowing 
when a particular message succeeded or failed. Implementation of messages with replies 
could be done in the Version I system through busy- waiting or spin locks, which was also 
very undesirable. The Version II protocol provides support for replying to every message, 
at a very basic level, should the user require reliable and synchronous transmission of 



An integer in the present implementation refers to any quantity that can fit in 32 bits. 
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messages. The implementation uses a reverse send from the recipient processor to the 
sending processor to acknowledge the receipt of a message. This addition has proven to be 
extremely useful. 

The Version II redesign was done mainly because of the complexity and the overhead 
of the earlier system, that prevented most control programs from hardly ever using the 
message passing system. 

To illustrate the present system, let us say for example, that the user wants to write 
an address handler that will receive a message composed of a memory address, and will 
respond with the value found at that particular memory address. This simple example 
will illustrate not only how messages are received, but also how messages are sent and how 
certain messages can be replied to. 

The conceptual design for such a user level message passing system is simple. Each 
mailbox handler is invoked with the first argument being the processor number that sent 
the message and the second argument being a piece of data that is wide enough to fit into 
a 32 bit quantity. We can therefore design the message handler such that when invoked, 
the memory address it needs to look at will be passed to it as the data associated with 
the message (since we do not expect our addresses to be longer than this). The message 
handler will essentially decode the message to find out what this address is, and return it. 

The handler can therefore be written thus: 

simple_decoder(proc, data) 
int proc; 
int data; 

■c 

return(* (unsigned int *)data); 
> 

After writing the handler one has to associate this handler with a vector number so that 
when other processors request this service, it will be performed correctly. This is done by 
the following piece of code. 

int simple_decoder(); 

mbox_set_vector(12, simple.decoder, "A test handler"); 

Once this call has been executed messages that arrive for vector numbered 12 will cause 
the simple decoder routine to be invoked automatically. 

But how does another processor invoke this routine? This is done by the mbox.send 
routine. If the simple_de coder routine is available on processor one can execute the 
following piece of code on any of the processors (including 0) to invoke the service. 

value = mbox_send_with_reply(0, 12, address); 

This will cause the handler that corresponds to the number 12 to be invoked on processor 
with the second argument being address. The call will not return until the other processor 
has responded with the value found at the given address. This call can therefore be used 
to provide synchronization. 
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There does exist another version of message sends that does not require the sender to 
wait until the handler for the message has completed executing on the recipient processor 
(called mbox_send). 

There are several important points to be noted about using the mailbox handler for 
communication: 

(a) Since message sending happens asynchronously, the execution of a handler resembles 
an interrupt. All caveats that apply to interrupts and interrupt handlers therefore 
apply to message handlers too. 

(b) The base system is extensible in the sense that more complicated protocols can be 
built on top of it. For example, the underlying system does not provide any support 
for queueing, although one can very easily build one for mailboxes that require this. 

(c) On the Sun, message handling is arranged to always happen on the process that sets 
up the handler using the Unix select system call. 

(d) Since the message system is based on shared memory, sending long messages is usually 
handled by sending a pointer to the beginning of a long piece of data. If the com- 
munication mechanism is serial, wherein a stream of data needs to be sent, sending 
a large number of messages may cause unwanted system overhead (although message 
sending is usually a single subroutine call). This can be avoided via a packet based 
interface to the message passing system the details of which are beyond the scope of 
this document. It is our opinion, that such links will be of such low bandwidth that 
they will rarely be used, if ever at all. 

(e) Most often, one may need a variety of functions that need to be performed in response 
to a message. Instead of defining ONE message handler for each such function, it may 
be helpful to collect related groups of handlers into a single handler, that dispatches 
to separate routines based on the data item sent along with the message. 

(f ) We have thus far used the convention that related messages thus grouped will be found 
in a single file, and that the vector numbers that correspond to message handlers be 
localized to a single .h file. This allows the symbolic use of handler names rather 
than numbers. 

(g) Where efficiency is important, the message handling system can be used just to set up 
pointers from one processor into another's memory. After such a set up is complete, 
the processors can read and write this shared memory as they please. This removes 
the burning of addresses in programs, but maintaining the integrity of shared data 
structures will entirely be the programmer's responsibility. 

Message sending and the invoking of message handlers is implemented under the present 
system using a so-called mailbox interrupt which is a hardware interrupt that allows one 
processor to interrupt another processor on the VME-Bus. This hardware support is critical 
to our current implementation's efficiency. To protect the integrity of certain implementa- 
tion dependent data structures the TAS or test-and-set instruction is used. It is important 
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that this instruction be supported truly indivisibly by the hardware even across the bus, 
for our implementation to work correctly. 

6.2.3.3 Support for Message Passing on the Sun End 

The development host in the system must have and support the basic primitives needed 
to do message passing with the slave or control microprocessors. The Sun on the other 
hand, runs a time-sharing operating system, and at any given moment there may be a 
number of processes on this machine all communicating with one or more slave processors 
across the bus-to-bus adaptor. 

As we mentioned earlier, message handling resembles the occurrence of a hardware 
interrupt, in that a routine is invoked in response to a send from another processor. On 
the Sun, however, when a message comes in from the slave processors, a decision needs 
to be made as to which process must be woken up or interrupted. The CONDOR system 
supports the notion of virtual processor. Every process on the Sun end, which desires to 
communicate with the slave microprocessors, must express its interest to the kernel. Since 
interrupts on the VME-Bus are vectored, this is done by the process expressing its interest 
relative to a particular vector. When a slave processor desires to interrupt the Sun, it does 
so using this vector. The Unix kernel traps on this interrupt vector and signals all processes 
that have expressed an interest in receiving the interrupt. Currently, only one process can 
own an interrupt vector on the Sun, although a low level mechanism does exist for multiple 
processes to be woken up on the same interrupt vector. 

An Ironies processor's memory is entirely dual ported, and hence totally accessible over 
the bus. The Sun has a region of memory called DVMA space (for Direct Virtual Memory 
Access). The DVMA area occupies the lowest megabyte of the VME 24D16 and 24D32 
address space of the VME bus. However, it is not convenient for an Ironies processor to 
communicate with the Sun using this space, since Unix memory management issues become 
complex. 

Instead, an extra 1 megabyte dual ported ram board was installed in the VME bus for 
use primarily by the Sun. This board can be thought of as the local memory that the Sun 
has control over. Ironies processors can directly communicate with this storage, instead 
of using the DVMA space on the Sun. If need be, this area of memory that the Sun uses 
for receiving messages intended for it, can be allocated on any of the Ironies single board 
computers' onboard dual-ported memory. 

From the Sun, the CONDOR system maps the entire VME 24D16 space (or VME 24D32 
space if the adaptor used is the hve-2000) into the user address space of the control process. 
Memory references to any of the Ironies or the Sun's 1 megabyte board on the VME bus 
become simple array references from a user's program. The PROC-RAM(processor) macro 
returns the pointer to the bottom of memory for the particular processor. For example, to 
write a value to location 100 in processor 3's memory one could use the following code: 

int *processor3_ram = (int *) (PR0C_RAM(3)) ; 
processor3_ram[100] = value; 
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The PROC-RAM macro is also used for programs running on Ironies processors to 
access memory of other Ironies processors. The code above would work, in fact, on any 
processor in the system. 

Even though the mailbox routines in the CONDOR system are highly efficient, it is 
sometimes desirable to directly use the VME bus shared memory for interprocessor com- 
munications. For example, consider a data structure on processor A: 

struct data { 

int a; 

int b; 
} data_A; 

Consider the following mailbox handler also present on processor A: 

get_data_pointer(proc, data) 
int processor; 
int data; 

•C 

return ((PR0C_RAM(PR0C_A) + (int) (&data_A)) ; 

} 

Processor B could define a pointer to such a structure, and initialize it's value using the 
mailbox handler made available on processor A: 

struct data { 

int a; 

int b; 
} *data_A = (struct data *) 

mbox_send_with_reply(PROC_A,GET_A_DATA_PTR, 0) ; 

The mailbox handler on A will pass the VME bus address of its data structure back to 
processor B. 

6.2.3.4 Message Passing and its Implication for Control 

The previous section has briefly outlined the message passing scheme present in Version 
II of the CONDOR system. The scheme is extremely efficient and fast since it exploits the 
shared dual-ported memory across the VME-Bus to the maximum. 

Table 6.3 summarizes the performance of the message passing system as benchmarked 
by a variety of routines. 

As can be seen from the table, the performance of the message passing system is ex- 
tremely good between two control processors and slows down only when messages are being 
sent up to the development host owing to the overhead caused by the Unix timesharing 
operating system running on this host. 
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Type of Operation 


MilliSecs/Message 


Variation (sees) 


Ironies to Sun 


34 


5 


Ironies to Sun + Reply 


38 


10 


Sun to Ironies 


4 





Sun to Ironies + Reply 


4 





Ironies to Ironies 


0.2 





Ironies to Ironies + Reply 


0.25 






Table 6.3: Performance of the Message Passing System. 



The reliability of the Version II implementation has also been unusually good. A number 
of other protocols have been implemented on top of the base message passing system, which 
will be described shortly, and all these other services perform extremely reliably. 

It must be mentioned that the message rates are not as high as servo rates. Conse- 
quently, messages are used only as signals to start and stop processes or control the flow of 
computation and are not used as timing pulses. 

Using the facilities provided by the message passing system judiciously it becomes pos- 
sible to treat a hierarchical controller as a truly object-oriented system that will respond to 
certain messages in certain ways. For example a low-level joint level PID controller could 
be described as an object that responds to different kinds of messages. These could be 
messages that 

(a) alter internal parameters like gains, damping co-efficients, position set points, etc., 
and 

(b) others that start and stop the execution of the servo loop or change the servo rate. 

Once the necessary code has been written to respond to these messages, and the program is 
running on a particular control processor, any other processor can now act as a supervisor 
of the lower level controller. This master processor can now send commands down to the 
lower processor telling it what to do. Since the protocol is clearly implemented by the 
message handler in the lower control processor, it is clearly specified and easy to change 
and hides all implementation details of how the messages are actually implemented, just as 
a good data abstraction requires. Such an implementation could be nested, with one control 
processor sending a message down to a lower level processor which in turn communicates 
with another processor to perform its task and so on. 

In fact, most of the control implementations described in the previous sections have 
been implemented using such an object-oriented paradigm. 



6.2.4 Virtual Terminals, The File Server, Debugging 

The CONDOR system requires the concurrent operation of several control micropro- 
cessors to perform its task. Programming such a complex MIMD machine would certainly 
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be a nightmare were it not for the numerous services that were built on top of the base 
system using the message passing facilities. 

These subsystems enable flexible interaction with a number of slave microprocessors 
at a time, provide file server capabilities on the development host, and enable symbolic 
debugging. 

It is in the implementation of such rather complex subsystems that our message passing 
design has truly paid off. Although the Version I software was flexible enough to implement 
these facilities, the system was complex enough to warrant most programmers to actually 
use only a few of its capabilities. 

6.2.4.1 The Pseudo Terminal Emulator 

The pseudo terminal emulator is a prime example of such a complex facility. It was 
originally intended to provide a terminal interface to the multiple slave microprocessors 
controlling the hand. Such a real-time facility to look at the states of the different machines 
was required to develop and debug the rest of the software. 

In the Version I hardware, this would have meant either attaching multiple terminals 
to the different nodes or having the programmer switch modes actively. Complex issues of 
buffering, forwarding and flow control needed to be addressed. The Version II hardware 
provides a simple solution. Different areas or windows on the bit mapped screen are used 
to indicate different processors. A multiplexor/demultiplexor process that routes keyboard 
input to the designated processor's input queue and routes the output from a processor to a 
particular window was all that was needed to facilitate a rather sophisticated user interface 
that enables the user to interact with any of the control microprocessors simultaneously. 
The protocol used for the transmission of the data is extremely simple and could be built 
and tested in a day. 

6.2.4.2 File Server 

Another such complex subsystem is the file server. One of the predominant needs for 
such a service arises from the fact that control programs, especially in a research envi- 
ronment need to collect data and store this data in disk files to facilitate further analyses 
and examinations. If programmers could write their programs to run on the slave control 
processors just as though they were writing their programs to run on the development host: 

1. They can debug their code faster since they can test it out on the development host, 
since it eliminates a few stages in the edit, compile, download, run, debug cycle that 
would otherwise be required. 

2. They can use the same model they use in programming conventional Unix machines 
as far as the file system is concerned. 

The file server on the Sun end provides such a transparent service to control programs 
running on the control microprocessors. For example, when the following program is run 
on the control processors, the openO call essentially gets translated to an mbox_send that 
sends up a message to the Sun, asking it to service the request. 
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FILE *fp; 

if((fp = fopen(filename, "r")) == NULL) { 

printf ("Couldn't open file y,s\r\n", filename); 

return(-i) ; 
} 

Other system calls related to the file system are also sent up to the Sun in a similar way. 

To make the file server efficient, shared memory is extensively used to avoid copying 
data. When a microprocessor performs a read or a write, the file server process running 
on the Sun reads or writes the data directly to or from the microprocessor's memory. No 
intermediate data copy is required. To perform a read, for example, the microprocessor 
would send a message to the Sun giving the address to read the data into, and the number 
of bytes to read. The data is directly transferred into the processors buffer. 

The file server is designed to operate in a stateless manner. All data necessary is stored 
on the microprocessor. The Sun server does cache some information, but if necessary, it 
can request the information from the microprocessor. Thus, if the Sun file server process is 
terminated and restarted, the microprocessor can continue its file operations without any 
noticeable effect. 

6.2.4.3 The Debugger 

Perhaps the most complex of all the subsystems to be implemented using the message 
passing system is the ptrace/wait emulation facility that enables sophisticated symbolic 
debugging of C programs running on the control processors from the development host 
remotely. In conventional Unix systems, debugging is done in the following manner: A 
parent process is set up to communicate with a slave process, which is the process being 
debugged. The user interacts with the parent and the parent carries out his requests, by 
controlling the slave process via a system call known as ptrace. This system call essentially 
is a message passing specification, which enables one process to control and trace another 
process's actions in terms of single stepping, setting up break points, examining register 
values and so on. 

Debugging is a rather unique activity associated with programming and programmers. 
In practice, even after good system design and careful coding, it is in debugging an initial 
system that the skill level and productivity of a programmer usually shows up. As the 
complexity of the system goes up, the need for such debugging aids becomes important. 
Before designing the second version of the CONDOR system, while we were evaluating 
our experiences with the first version, it was the debugger that occupied most of our 
thinking. This was an area we felt sorely needed addressing. The solution we came up 
with, was to avoid writing a new debugger, since most conventional Unix debuggers did 
have the capabilities we needed. What they lacked was the ability to debug a process 
running independently, perhaps on another machine. Hence, we decided to implement an 
emulation facility for the ptrace system call using the Version II message passing system. 
In this manner, any conventional Unix debugger could act as the master during a debugging 
session and could communicate with a slave process running not on the same machine, but 
on one of the control microprocessors. 
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A short table of the message passing operations needed to implement such a scheme is 
shown in Table 6.4. 



TRACEME 


Start tracing the process 


ATTACH 


Attach to a particular processor 


DETACH 


Detach from a processor being debugged 


PEEKTEXT 


Look at a program running on a slave 


PEEKDATA 


Look at the data on a slave 


POKETEXT 


Modify the program running on a slave 


POKEDATA 


Modify the data running on a slave 


KILL 


Kill the slave process 


SINGLESTEP 


Single step the slave process 


CONT 


Continue the slave process 


GETREGS 


Get registers from a slave process 


SETREGS 


Set the registers on a slave 


START 


Start up the slave process 


STOP 


Stop the slave process 



Table 6.4: Opcodes for messages to implement the ptrace emulation 



This emulation facility can be linked into any conventional Unix debugger. Once this linking 
has been done the debugger can be used to debug control processes running on the slave 
microprocessors across the bus to bus adaptor. 

Such a remote debugger interface can be used in many ways. The first allows the user 
to start executing a program directly under the debugger's control. This mode would be 
used when a bug is actively being tracked down, and setting initial break points might 
be necessary. The second mode allows the debugger to be attached to a processor after 
execution has begun. For example, if a program were in an infinite loop, the debugger could 
be attached to the running program to determine what went wrong. Finally, if a program 
receives a fatal exception, for example an addressing error occurred, the debugger can be 
attached after the error occurred to help analyze the problem. 

Once the debugger has attached to a process on the slave control processor, all the 
capabilities of the debugger can be used to debug the program running on the remote host, 
just as if it were running on the development host. 

Besides these important utilities a host of other programs have been written to aid in 
program development on the CONDOR real time system. These include plotting programs 
to graph real time data collected on the slave processors, simulators that provide a three- 
dimensional graphics capability to the industry standard X window system, a number of 
programmer libraries that can be used on both environments, and diagnostic programs for 
the different pieces of hardware that exist in the system. 

Taken together, the system comprises of an architecture that we feel comes very close 
to satisfying our initial design goal of providing a flexible software environment in which a 
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researcher can design his real-time control programs without sacrificing performance. 
6.2.5 The CONDOR User Interface 





Figure 6.3: The CONDOR running under the X Window System. 

The file server, debugger and virtual terminals combined together form the CONDOR user 
interface. This program is an X-window system based application that programmers utilize 
to interact with the slave microprocessors. The user interface provides one virtual terminal 
for each slave processor, it runs a file server, and it can start debuggers. Figure 6.3 shows 
the screen of a typical CONDOR user interface session. 



6.2.6 Controller Implementation 

To make the above abstract discussion of the computational architecture more concrete, 
in this section we outline how the actual partitioning has been done for the controller 
implementations that have been described in the previous chapters. 

The current digital controller implementations use four processors. One processor is 
allocated for performing the joint-torque and tendon tension level servoing of eight joints 
at 400 hertz. Another processor is dedicated to controlling the xyz table. The fourth 
processor is a master controller. 

An abstraction similar to that used for device configuration is also used for configuring 
the hand control programs. There is one central configuration file, which specifies which 
joints are allocated to which processor. This configuration file also specifies which A/D's and 
D/A's are allocated to a particular joint. This permits hand control programs to developed 
in a modular fashion. Changes in hardware occur in terms of changed connectors, boards, 
and hardware addresses. To cope with these changes, no changes to the actual control 
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programs is necessary. All that is needed are small changes to the controller file and 
recompiling the entire hand controller system. 

The trajectory generator currently executes at 50 Hz on the master processor. Besides 
executing this slower loop, the master processor also performs a number of other functions, 
including: 

(a) It forms the primary interface to the Sun, to load and save entire sequences of motions. 

(b) It provides a sophisticated interface to the user, who can select a subset of joints to 
monitor at any given moment. The required controller variables can be tuned from 
this level, and the status of the hand at any given moment can be ascertained. 

(c) It controls the execution of the servos on the slaves. Using the message passing 
system, it can enable or disable servos on the other processors, find out their status, 
or restart errant programs. 

The current implementation is also very modular, in that the actual servo portion of a 
program that implements the control computation is contained in a single file. By replacing 
this file with another of his own choosing, a prospective user can begin to experiment with 
low, medium and higher level control algorithms, without having to rewrite or even look at 
the rest of the user interface programs. 

Besides the actual real-time programs, the hand control environment also comprises of 
programs that run on the Sun. These programs include a real-time plotter that allows a 
user to monitor any of the controller variables in real time, and a kinematic simulator that 
can be used to generate input to the trajectory generator running on the master processor. 
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Conclusions and Future Work 



This report has looked at different problems that arise in actually controlling a robot 
hand to perform simple tasks. The bottom-up approach taken in this report is perhaps not 
representative of other efforts that have concentrated on a single theoretical issue. However, 
it has resulted in valuable tools and experience that can now be used to deal with the truly 
important and relevant higher level issues. 

To complete this report, I would like to briefly describe representative problem areas 
that need to be looked at in the near future. These include extensions to the work presented 
herein, and new problem areas that have been suggested during the initial experiments that 
I have begun performing with the controller implementations. 

7.1 Control 

There are a number of problems that still need to be resolved with respect to the 
control of dexterous robot hands. With respect to position control, we have shown that 
stable control of such hand-arm systems is indeed possible, and that simple hierarchical 
controllers can perform the required tasks. The interesting task that remains to be done is 
to mount such a dexterous hand on a robot that has a multi degree of freedom wrist. This 
will increase the versatility of the hand by increasing the number of tasks it can be used 
for tremendously. 

Achieving stable force control in manipulation tasks however, does not seem to be so 
simple. In particular the experiments performed with the force controller implementation 
seem to indicate the following areas in which much fruitful research can be expected in the 
future. 

Actuator Modeling: Part of the problem involved in the current implementation of the force 
controller implementation is that there is no good underlying model of the actuation and 
transmission systems that the controller can use. The pneumatic actuator is in fact a highly 
non-linear system with stiction and coulombic friction. 

Torque Estimation: Since the Utah-MIT hand does not have any torque sensors, the torque 
about a joint must be estimated. Without such information, there exists no good way of 
determining how well the force controller is performing. In practice these torques can be 
estimated in many different ways: 

1. From the sensed tendon tensions: 

T i = (T/i - T e i)ri 

This is equivalent to making an estimate of the joint torques, from the input variables 
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to the controller. Since the tendon tensions are measured fairly close to the joint, the 
friction between the actuators and the sensors can be neglected. 

2. From the outgoing actuator voltages: 

Ti = (Vji - V ei )ki 

This assumes that the estimate of the joint torque is made from the output variables 
of the controller. 

3. Use a sensed finger tip force and use the relation r = J T f . This method is feasible if 
there is some kind of sensor at the finger tip that can output sensed force information. 
This is true of the Salisbury Hand which has a ball sensor mounted on its finger tips, 
which provides force and torque information, but not of the Utah-MIT hand. 

4. From the position error: 

n = Ki60i 

where K{ is some specified joint stiffness. 

5. From estimated accelerations. 



T{ — Mi9i 



7.2 Planning 



Currently there does not exist any flexible manner in which a high level task can be 
planned on the Utah- MIT hand. It would be interesting to apply the algorithms presented 
in the literature to choose grasp points and evaluate if indeed they enable achievement of 
stable grasps. 

The higher level problems of feasibility and reachability mentioned in the introduction 
certainly need to be solved before such algorithms can be put to use in practice. Trying 
to use such high level planners could indicate the importance and relevance of the various 
issues involved. 

There are many issues with respect to planning that we have only hinted at. The 
level of geometrical modeling needed to achieve stable and dexterous manipulation and the 
sophistication of current algorithms both need to be enhanced for the development of a 
more or less automatic programming environment for dexterous hands. 

7.3 Sensing 

It would certainly be instructive to mount tactile sensors on the hand and try to use the 
information coming off of these sensors while performing grasping and manipulation oper- 
ations as well. In particular, the use of such information in the detection and prevention of 
failures during such tasks needs to be studied. The interface between such high-bandwidth 
sensors and the hierarchical controller needs to be made in a principled way. 

The interaction between such sensors and higher level planning or learning algorithms 
that learn to plan over successive trials is also a subject that could bear fruitful results. 
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7.4 Conclusion 

In conclusion therefore, I would like to mention that this report has looked at problems 
from widely different areas. We have looked at problems involving kinematics, control, 
planning and computer architecture. The problems involving kinematics and control were 
solved and a novel computational architecture was presented as a tool with which to address 
the experimental issues that arise in controlling dexterous robotic hands. A new force 
control algorithm was presented that is computationally very efficient. Future effort will 
concentrate on experiments that look at other issues pertaining to force control and higher 
level issues involved in the planning of grasping and manipulation operations. 
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Appendix A 



Kinematics of the Utah-MIT hand 



This appendix deals with computing the forward kinematics of a single finger of the Utah- 
MIT hand. 

The numbering of the various fingers and joints are indicated in Figure A.l. 



Finger 0. 




Wrist Side 

for \ ' Joint 

Right-Handed Hand 



Palmar Plane 



Joint 3 



Joint 2 



Joint 1 



Figure A.l: Numbering of joints on the Utah-MIT hand 
A picture of the finger geometry is included in Figure A.2. 

A.l Co-ordinate transforms based on D-H matrices 

The Denavit-Hartenburg notation can be easily applied to denote the various co-ordinate 
systems associated with each finger. In what follows, the zi axes are aligned with the axis 
of rotation of joint i. 

These parameters are included here even though the controller and the rest of the software 
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Figure A.2: Single finger - Non thumb 

use vector manipulations rather than matrix calculations. The popularity of the D-H 
matrices after the publication of Paul [1982] and Craig [1986] has made this notation more 
accessible and somewhat of a standard. 

Let the co-ordinate system whose axes are defined by [x ,yo,zn] denote a co-ordinate frame 
affixed to the palmar plane of the Hand. This co-ordinate system is the one relative to which 
all other co-ordinate frames will be expressed. This frame is chosen so that positive x and 
y values will be on the palmar plane and the z axis is perpendicular to the palmar plane, 
pointing upward from it. 

Then the relation between this frame and the first joint axis frame of a non-thumb finger 
can be expressed by: 

Trans(y ,r p ) ■ Trans(z ,l p tan(<f> p ) - h p ) • Rot(y ,n/2 + <£ p ) • Rot(z',ir/2) 

where z denotes the zn axis after the rotation about yn has been performed, <f> p denotes 
the angle made by the axis of rotation of joint with the palmar plane (which is 12 degrees 
for non-thumb fingers), r p denots the distance separting the joint axes and l p denotes the 
length of the palmar plane and is equal to 1.05 inches (please refer to Figure A.3). 



X A n = 



sin(<f> p ) 

1 



cos{<j> p ) 








cos{4> p ) -sin(<f> p ) l p tan(4> p ) - h p 
1 



(A.l) 
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Palmar Plane 





Joint Axis 



Figure A.3: The relation between the palm and the zero joint frame 



where r p refers to the distance of the finger from the x axis as measured along y (which 
is 1.42 inches for finger 2, and 2.69 inches for finger 3), and l p refers to the length of the 
palmar plane as mentioned above. h p is the height of the palmar plane above the joint 
axes which is equal to 0.95 inches. 

Once the frame affixed to joint 1 has been determined the other frames associated with the 
finger joints can be determined by using the standard D-H matrix given by: 



%+i = 



Oj «j t '0 o <j|ij a flt'Ot 

S a C a d 

1 



(A.2) 



where C; denotes cos(0i) and Si denotes sin(0i). 

The first link of the non- thumb fingers makes an angle of 30 degrees with the axis of rotation 
of the zeroeth joint of these fingers. This angle is denoted by (j> . l denotes the link length 
of this first link and is equal to 1.2 inches. 
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Using the above equation, we can write: 



X A,= 
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So 
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(A.3) 



L 



which can be derived from the fact that a is -W2, a = losin(<f> ), and do = 7 — - + 

cos(<p p ) 

Iqcos(4>o). The angle </> denotes the constant angle made by the link between the joint 1 

axis, and is equal to 30 degrees. 

The remaining three axes are simple revolute axes. All of these three axes are parallel and 
are perpendicular to the plane of finger movement called the operational plane. Their A 
matrices can be seen to be: 
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(A.4) 



where h is 1.70 inches, l 2 is 1.30 inches, and / 3 is the distance from the contact point to 
the last joint's axis of rotation, which is 0.735 inches. 

From the last of the above equations, it can be seen that the contact point between a 
grasped object and the finger tip is assumed to be a constant given by / 3 . In practice, this 
is only an approximation. In fact the contact point ought to be expressed as a vector in the 
last co-ordinate frame of the distal joint. This would be possible for example when tactile 
sensors are mounted on the finger tip enabling the acquisition of such information. 

The A matrices given above make the solution of the forward kinematics problem easy. A 
summary of the D-H parameters for the non-thumb fingers is given in Table A.l. The final 
mapping is given by Equation A. 5. 
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Table A.l 


: D-H Parameters for Non-Thumb 
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(A.5) 
where Sij refers to sin(6i + 0j), C t j refers to cos(9 { + 0j), Sijk refers to sin(9i -f 0j + B k ) 
and Cijk refers to cos{9i + 0j + 6 k ). (Note that the numbering scheme is different from the 
conventional usage of the D-H parameters since we have introduced an extra constant °A\ 
matrix. 

Computationally, it would take 26M+16A+8T operations to compute all elements of the 
forward kinematics for a non-thumb finger. 1 If we are merely interested in computing 
the cartesian positions of the fingertips, it would take 12M+14A+8T to perform the above 
computations. For three fingers, this number works out to 78M+48A+24T operations. 

1 xM+yA+zT refers to x multiplies, y additions and z transcendental function lookups. 
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A.2 The thumb frames 



The Utah-MIT hand has a four degree of freedom thumb whose co-ordinate frames are 
different from the other non-thumb fingers. The main differences are caused by the fact 
that the zero'th joint on the thumb rotates about an axis that is parallel to the palmar 
plane and is aligned along with the xo axis. Joint 1 of the thumb is also only 0.4 inches 
above the joint axis. Furthermore, this axis is perpendicular to the joint axis. 

This means that for the thumb the relation between the first two frames can be expressed 
as 

Trans(yo, r p ) • Rot(y , k/2) • Rot(z , x) 

where r P for the thumb is 0.695 inches, and z denotes the zo axis after the rotation about 
the yo axis. 



Expanding the matrices, we get: 



B Ai = 



10 







-1 r„ 



10 
1 



(A.6) 



The derivation of the 2 A\ frame is relatively straightforward. With a set to a constant h 
(0.45inches) and a set to -ir/2 and using Equation. A.2 we get: 



M 2 = 



Co — So hoCo 

So Co hoSo 

0-10 

1 



(A.7) 



The orientation of the different co-ordinate frames are illustrated in Figure A.4. 

Since the thumb's three distal joints have the same structure as the other non-thumb fingers 
the other A matrices turn to be the same as indicated above for the non-thumb fingers. 

Therefore the remaining transforms can all be lumped together as: 



2 A = 



Cl23 — Sl23 /3C123 + I2C12 + l\C\ 

S\23 C123 /3S123 + hS\2 + hS\ 

1 

1 



(A.8) 



The D-H parameters for the thumb are summarized in Table A.2. 



%A.2 The thumb frames 
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Figure A.4: The first two frames for the thumb 



Multiplying the individual transforms out, we get: 



^5 00 
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— S123 


^501 
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— Cl23 


^5 02 


= 





-^5o3 
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—'3 £123 — h S12 — h S\ 


°^5 10 
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—So C123 


o A5 " 
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So S\23 


-^512 
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-Co 


°^5 13 
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— So (I3 C123 + h C\i + l\ C\) — ho So + r p 


^520 


= 


Co C123 


°Ac 


= 


— Co 5i23 


A522 


= 


-So 


^523 


= 


Co (/3 C123 + h C12 + h Ci) + h Co 


°A. 

^530 


= 





■^•531 


= 





^5 32 


= 





■^5m 
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1 



(A.9) 
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Computationally, to compute all elements of the frame for the thumb, it takes only 12M+9A+8T 
operations. Computing just the cartesian co-ordinates of the tip of the thumb can be done 
in 8M+9A+8T operations. 



Table A 



2: D-H Parameters for the 


Joint+1 
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a s - 
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-w/2 
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Thumb 



The entire forward kinematics for the Utah- MIT hand can therefore be done in 94M+63A+32T 
operations. 
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